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,  Dynamics. OF.coNSTRAiNED  systems 
BASED  ON  Mass-orthogonal  PROJECTIONS 

M.  Sofcr,  D,  Bich  Rt  H.  Bniuchll 
intdiut  Mechaiiilc  •  ETH  Zeatrum  •  (S-8092  Zurich 


AbtUacK  We  deicribe'*  mcUi^  hated  da  iiit»«nhoiaaal  pnjeirioai  that  can  be 
Hied  10  elinidaie  the  alfibnic  Variablea  ia  the  DAEt  of  iodea  2  of  nahibody  syaeei 
dyaaoUcafiediicioi  diem  to.ODEif'A  choice  aaoof  the  inflaiieljr  nany  ODE 
jyiaeiu  that  dcacnhe.ihe  dynanica  conectly  It  pn;caed.~A  ledoctioo  of  the 
compiBdoiitl  oo«  of  UiMc  alfebn  openiiooe  it  deaerihed.' We  pmeai  DYNAMIIE, 
a  loolddt  hiatd  aoftwaic  for  die  amolaoan  of  etokihody  ayneat  dut  liB{iieiiieaB  the 
iMduda  diacaated,  and  Ulunate  in  aupUcicioa  to  a  tow:voiia|e  cnnii  tnaker. 

1,  Introductioo 

Diffaem  approaches  ate  potuble  for  the  delation  of  the  motion  of  a  muliibody 
system.  A  let^  of  methods  cdmmanly  itt'uw  tnaybe  found  in  (1 1]  or  [15],  A  minimal 
descriptioa,  .e.il  with  liiwfe's'  methwptovideaj^''nDallest  system  of  diffeiential 
etpiatioas  but  ^efs  a  few'drawbackL  Some  of  diese  im:  ^  impoasibility  of  describinf 
the  whole  coafi|\Bation  spm  in  a  sin|le  coonUnate  diatt  wit^t  singiilarities  in  the 
presence  of  kina^tticid  loops;  the  difn^ty  inbernt  ih'the  calculatioo  ttf  the  eliminated 
constraint  rractUns  and  tbe  oonsidetatioa  of  Mcdoti  forces;  the  faa  that  the  eqnatioat  may 
be  etitieniely,d(^Uca^~  Le..'the  functkmi  describini  the  diffetendal  equations  are 
dUi^t  u'derive  and  etcpeosive  to  oompote;  the  lack  of  modularity,  in  the  sense  that  the 
knowledfc  of  the  equations  of  motion  of  subsystems  is  difficult  to  use  in  the  derivation  of 
the  equatidns  of  the  fiiU  system. 

For  these  leasoas  one'of  the  widely  used  procedures  in. the  analysis  of  multibody 
systems  is  to  describe  the  system  tedundantiy:  one  uses  more  variables  than  the  strictly 
necessary  to  describe  the  motion  locally,  and  imposes  coasitiints  on  the  motion.  With  this 
additional  expense  it  is  possible  io  obviiue  all  of  the  above  disadyantafes  of  Laftanie's 
method.  The  equations  to  be  solved  fane  initially  a  mixed  alfebtaickliffaential  system  of 
equations  (Df^),  the  alfebcaic  variables  beiof  tfae.conatraint  reactions.  These  can  be 
treated  directly  u  DAEs  usinf  different  metbods  [1,7.8,10,12,13],  or  they  can  be  reduced 
to  a  set  of  otdinaiy  differential  equations  (ODEs)  bjr  eUnanatinf  the  al|ebiaic  variables. 

We  describe  hem  a  method  bam  on'mass^ortfaofoaal  psojecaions  developped  in  the  past 
few  years  (34,d,18-21].  The  consoainf  reactions  are  eliminaied  in  an  extremely  leneral 
manner  the  usage  of  mass-ottbogonal  projecm  (a.p)  in  velocity  space;  a  prc^ectt  onto 
the  subspace  of  admissible  velocities,.  P  is  its  complement.  In  the  case  of  workfiee 
cbnstnunti  the  projectors  can  be  used  to  ^lit  the  DAEs  into  a  pure  ODE  for  the  motion  of 
the  consttained  system  and  algebraic  expressioas  for  the  constraint  leacnons  in  terms  of 
position  and  velodty.  The  resulting  ODEs  for  the  motion  ate  not  uniquely  determined  by 
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die  projecmrK  w  in  sectioo  2  two  infifiitt  £imiJies  of  WEs  that  comctly  descnbe 

'  the  moabd  of  &'constiiiW,qisira  ^  disam  briefly  some  supple  ODE  fotmuluioiis 
c(«finaeimti»^'fa&lies.t'  *  'J  . 

prmim  sn  ciriui^oii  of  die  linw  plgebm  ramputaiioiis  that,  under 
censin' sssunffliic^'^ugntfi^tly.tedu^  the'cat^utandiiil  coat  of  the  right  hand  side 
of  the  ppELtlliMluiunpMiaps'^^bejriet  in  i'Kdiu^  ikacriprioo  of  the  muldbody 
sywin  in'wt^'eachbf  the  hbd^  ia'rixKfeU&  s^antely^ 

The  iih»ht  meth^  ia'well  mtal  faraiapiaiealsiriiiilaripns  of  rinillihody  systems.  In 
secbbn,4^we''descritw^D'yNAMTTE;(3]/ii^l-ldt  laied'sbfiwaK  that  implements  the 
mhd^'aod  algoriihmi  diacniaed  here.'Tlie  rimhla^^th  DYNAMITE  of  a  low-voltage 
citcuit  bmalEer  (3]  is  iUuairated  iaiiactira  j-  KInanaticri  lob^  flictiaa  in  the  joints  aM 
coUisiaiis'ite.the  main  difSc^iia'piimaued  hy^this  iiiduririid  andicarioD. 

The  eqnadcns  obtained  fiv  'tlm  deacrip^  of  cbpstntmed'syttdns  ate  not  only  of  value 
as  a  buit  for  tiiniuhiidoi  btn'th^'lead  ihemaldf  fbranaly^  It  is  possible 

to  describe  holbnwnfcally  caaswined  CTiMiaw^  hamiliniiian  ODEs,  thus 

sUowing'lhe'm^V  dK  cwob^ti  insnmntarium^  bodflguiaiion  manifold  of  a 

holbobmiddly  coi£Knuned'tyMBth'can'alae'*fe,idewed  m  Imbedded  in  a  eiiclidean  space 
with  conaam  motic.  Si^ie  fotmulu  for  the  curvature  of  the  cdnfiguniios'maotfold  of 
the  conmined  sysira  may  be  obtained  [Q'Accoitdihg  »  Syhp  [22]  this  has  implicarions 
for  the  siabiiity  ^  modoo  for  otbUs  of  the  constrained  system.  Cotiespooding  i^ts  will 
be  presented  elsewhere. 

2.-hbse-ortho|dnal‘projfdort;Mid  OpE'fonnaiatioM 

Comrider  tie  moddn^^.a^ynami^  synm  deamtied  witi  n  coonUnates  q,  r  S  n  non- 
holodariiic'velpci^  (Ktretnerets  uapd  am  mauix  M;  ies'A  be  the  invcsie  of  M  and  T(q,u) 
be  tfaeotireatiM  fcr  dre  Idnetti 

Let  the  system  be'sttijen  to  m  cMstiaints'described  by  the  (lamj-matrix  E  at 
,  '  'eTu-O.  (1) 

Re'matk  that  bolonomic.  constraints  have  to  be  diffetentitied  once  to  take  this  form.  We 
contidre  hm  only  icteoniniic  oonsttainis  and  attume  that  the  tnatrU  E  hat  fiiU  tow  rank. 
i.e,  that  tie  coostrainis  are  independent 

Introducing  the  canonical  momentum  p  •  Mu,  tie  morion  of  tie  system  under  tie 
applied  geneeslised  fbtoet  Q  it  described  by  the  DAE  system  of  index  2 

uaAp  ,  ^wBu  .  (2) 

f-O  «Q +E2.  ,  E^u-0. 

In  thit  expression  Q  hat  to  be  calculated  as 

Q-Q+^-C(u.u). 

U.,  as  ti'i  sum  of  the  applied  fences  Q  and  additional  inertia  terms,  quadiatic  in  the 
velocides  and  due  to  tire  non^isstaot  mass  matrix  and  tie  non-holooomic  velocity 
parameters]^. 

We  asnime  for  tie  purposes  of  the  present  descripdon  that  tie  generalised  forces  Q 
may  depoti  on  (tq,u),  bus  not  directly  on  X.  'nds  rules  out  flicuen  forces;  see  [3]  for  their 
inclusion  in  the  considerations. 
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.2,1  Utm^firdtogonai projectors’  ' 

ConadCTthe  onhchprojector  (in  the  mesic  defined  by  the  mus  mitnx  M)  a  on  the  null 
space.ttfEi.this  ntninUy  in  the'dynaimcs  of  the  system  in  one  fonn  or 

the  other,  soto  other  luthors  also  use  it  explicitly  [2,12,16,17].  Let  P  'be'its 
compleiiientaiy  pnjeodr.  They  sad^  the  leladons 

ap  =  0  ,  a'M>Ma  ,  .  (4) 

The  ptojecton  can  be  calculated  U0&  m  auu^^oos  as 

G-«iTAiV'P»"AEG-'ET'',  oi’l-p.  (5) 

Intioducing  the  matrices 

;flaE’G'!E!,  (i)>Ga'fa^Q^  ,  (6) 

the  derivaiives  of  the  projectors  are  given  by 

A  «- p‘»A(ct^lJCp-ia).  (7) 

Let  lis  introduce  as  a  shotfiuuid 

'‘o"®'’' •  (*) 

to  denote  the  a  lesp.  P  projectioos  of  a  co-vector  (forces,  momenu)  x. 

22  FomudadM  as  ordinary  t^ertndal  eepiadons  (ODE) 

There  irelnariy  different’ systems  of  oirdinasy  differential  equations  that  describe  the 
system  (2)  (see  , [18,21]),  in  the  sense  that  their  solutioo  sets  contain  all  trajectories 
(q(0,p(0)  ^  >l>c  DAE  (2).  A  first  infinite  fsmily  ef  such  ODE  formulations  is  given  by 

FI:  u-APa  +  Xpj  ,  4«Bu  .  (9) 

where  the  miirices'X  and  Y  can  take  any  value,  depending  (teguiariy)  on  any  of  the 
variables.  The  solutioos  of  (2)  constituie  an  invariant  m^old  (pg  ■  0)  for  these 
equations.  Remark  that  these  equadons  tqxeieat  a  second  order  system  m  q  if  and  only  if 
the  matrix'Aa?  +  XpT  -is  invertible.  If  one  chooaes  X  »  0  then  every  trajectory  of  (9) 
satisfies  the  conatraints  (1),  but  in  general  is  a  solution  of  the  DAE  (2)  only  if  it  lies  on  the 
invariant  m^old  (pg  •  0). 

A  second  infiniierttnily  of  ODE  formulations  of  (2)  is  given  by 

F2:  u»Ap„,  ,  (10) 

ji»Q„-A'pp  +  P^x  . 

where  the.co-vectqr  x  can  take  any  value,  d^endiog  (regularly)  on  any  of  the  variables. 
All  solutions  (q(t),'p(t))  of  (10)  are  trajectories  of  the  constrained  system,  in  the  sense  that 
there  is  a  X  such  tto  (q,Pg  A)  wives  (2). 

Fonnulatioos  in  the  first  family  have  the  adyaat^e  tbaL  for  trajectories  that  satisfy 
(pg«  0),  the  variable  p  letaitis  us  ^ysical  irnerpcMtido  u  the  canonical  momentum  of  tte 
fr&  system.  Comparing  (9)  and  (2),  this  iiz^Ues  that  the  non-working  generalised 
reactions'  ate  given  by  ^  >  p  -  Q  arid  are  calculated  during  the  evaluationx  the  tii^t 
hand  side  of  tte  idiffeiendd  equadon.  The  teacdons  m  therefore  available  during  any 
numerical  integtatidn  of  fysiem  (9). 

In  the  seco^  family  of  fotmuladons,  the  variable  p  cannot  in  general  be  interpreted  as 
the  canonical  momentum  of  the  free  system:  it  is  just  an  auxiliary  variable.  In  the  general 
case  the  constraint  reacdons  are  not  immediately  available  durmg  a  simuladon.  An 
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advwt^  of  die  seimid  u  die  fact  dm  my  soludon  of  the  diffetendil  equadons  (10) 
^cdncspoadt'u  a  njcctoiy die  oagasii^  sys^ 

'  SThe  innsecon  of  boA'timliKi'of  fdtmiilati^  ia  not  entity;  indeed,  it  follows  easily 
■fipni(9)'ahd(10)'d|atitisjivenby;  , 

R:  ““APd  -  ,  (11) 

-  wbm  Z  ^  my  oatrix  ilqp^ng  (tegi^y)  M^any  oe  variaUes. 

23  Exa^UscfOpEformlationi; 

.,;We"choae  as  'esm^l^  be  foraiiilaiioqa  described:in  TnUe  1.  Remark  that  these 
fbtmiilae  apply  only  in  the  cue  whde  M  (and  hence  A),  are  coostantt  the  tenenlisaiioa  it 
essentially  trivial. but  leads  to  builder,  foniulae.  FotmiiUdon  1  is  the  stmdard  DAE 
fotmiiltdon  of  index  1  solved  for  the  Unematictl  vaiitblet,  u  deacribed  for  instance  in 
[10],  Formulations  1  to  4  were  already  descnbed  and  'diunsaed  in  [IS],  whereu 
focmuladon  5  cdtresponds  to  the  "projected  equadoas  of  modon"  presented  in  [16,17]. 
The  term  (-pp.)  !n:farmuladon  6  causes  the  invariant  manifold  (p«  >  0)  to  be 
asymptotically  sable.  ' 
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All  fonnuladoiu  describe  the  conttiaioed  dyiuumct  properly,  but  they  differ  in  some 
propertes'tha:  may  be  relevant  for  their  numerical  neatmenL  See  [18,19]  for  some 
numeiial  cbinptriaaas  and  [21]  for  a  thorauih'diacutaibii. 

Table  2  shows  the  intefi^  modod  for  the  ODE  of  each  of  the  selected  fotmuladoas. 
The, integrals  of  formulation  I'are  actually  a  diaaidvanttge,  u  they  cause  the  well  known 
numerical  drift  of  the  solutioes.,Tlie'  second  columh  cberespoods  to  the  norm  of  p.  in  the 
metric  of  A  (which  is  the  cdrreb  mmiic  for  cb^ranon);  Um  *  for  formiilatioo  6  iiuicaiu 
that  this  horin'diminisbes  expohcadally  (widi  inpooent  :2{i).  In  the  third  column  appear 
the  possible  holohdmic  constraints.  Finally,  the  last  column  cone^onds  to  the 
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equiuu^  wbich  givei  a  ptopcr  inteinl  of  motiao  only  when  the  applied  foioet  Q 
^an  cxm^adve.’ Remark  thu  the  enenv.  equadon  is  sadsiied  io  a'ittoniet  sense  for 
'fab^lioo'4.\Fofini^iions  4,abd  6  have  the  fmtber  propeny  that  a  solution  on  the 
ihvariaot  m^oU  (&  a  0)  U  stable  if  a^  only  if  it  is  stable  at  a  najecioiy  of  the  DAE  (2), 
at  'em  osUy.be  shoM  usiog  the  pioperties  oi  the  second  fantily  and  the  non>incieasing 
natuiettf  ||pji|L 

HH  ccnaSalott  ( 1)  can  be  written  equivtlently  with  any  invettible  (mm)-mairix  S  as 

SE^uaO.  (12) 

Fdnbiilatiods  2,- 4  and  dare  invariant  with  respect  to  the, choice  of  S;  l,3aod5aienot 
Fbitniilatiads'3  and'S  have'lhvariant  manifolds  cones^hding  to  possible  holoaomic 
bbottraihts;  the  motiao  on  these  nianifolds,'hot^er,  de^iidt  on  the  choice  of  S,  i.e.,  on 
the  fonnulatiaa  of  the'coostntintt: 

We  have  ehotea  foimul^M  4  for  ocr  fottber  det^qparents.  This  choice  is  baaed  oo 
our  nunterical  expenmenu  (13.19],  on  the  invariance  and  stabiiity  properties  of  the 
equatiebt^  and  on  the  foct  that  dm  is  no  risk  of  attificialiy  stiffening  tte  equations,  as  may 
be  the  case  for  formulatian  d. 

3.  Mutticrical  linear  algebra 

The  oompuiatioa  of  the  msoibes  appearing  in  the  formulae  above  is  not  rt.  staiy.An 
efEdem  cociqtatatiaa  avoids  both  the  matria  invenioo  and  nMix  multiplintions,  replacing 
them  with  the  sblutiba  of  systenis  of  equaticiaa  and  mattix-vector  nuiltipUduions.  Apart 
from  the  caloilatico  cf  inertia  ietms  and  applied  foeois,  the  bulk  of  the  oomputational  eSen 
in  all  fottnulatioos  is  coostitutfxl  by  the  oqo^atatioa  of  the  Cholesky  foctor  of  the  matrix 
0.  Once  the  factor  is  cbmputeid;  foraiulatim  l  and  3  require  the  solution  of  a  single 
equstico  with  matrix  O,  the  others  require'  two.  For  some  systie.-ns'  it  may  be  advisable  to 
organise  the  computations  in  a  different  manner,  striving  bisiead  equations  with  the 
icdt&ute  system  matrix 


The  calculations  presented  above  in  terms  of  0  amount  to  the  inveisica  of  (13)  (using 
lange  space  techniques)  in  the  fotm 

fMET*  rAOiroAEiroo-iro  oi  (i4) 
[e»  0  J  “Lo  0  J-Lo  -I  JLo  G-J  [e'^A-iJ 
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'wheie;l;is;ite''(m)  i^d^jmai£;Rein^j^  saving  an  cquadon  with  matrix  (13) 
roluan  thehlo  solving  u  'emunon  with  the'snaller  and  positive  definite  matrix  G,  and  a 
fewtMtrot-vffmr  tnuInpHcid^V , 

'  ..'For  miiltib^  *y*^  thcie  is  a  desctiptioa  vrith  a  constant  dltigonal  mass  matrix 

My^'jbu'eacfrioifyjlsjti^llei  detailed-, in'the:next‘sectioo.  This 

'  (iesaipiiin  Waib  u  iatje  syta^'^  equadm  Wbn  altetnadw  descriptions 

-  '(e!^ide^6inr'rspiin^fTme  ^theTsyittm' in,mihinial;coadin^),^but,has  other 
{adyabi^^(aee,;amlMOiaa)T^’e  deschte'toe  h^^io  uae'the^siic^  sBvxnm  of  the 
'eqmS^ibitd^idgiii(lritiily^*cci^iiaii^i^dtll>eline»algebi«ca'chladons. 
'^Fint  n«e'tlii£^tuiib‘lb'the"coMtaot  diagonal  M  invenion  acconUng  to 

eqiiaiidtt'(U)  bnddmM'mra  cfaeaper.'Iodeed(  A  *  M,'.'iMd  be  calculate  only  once  at  the 
.,begiinmt^asimulaiioit;^and  the  ^dplicattairitfa'A'ia  exne^^  inexpensive. ' 

’)  For, "most  mtchanlal  sysKma'^^  constraint  InvdIvM'at'most  twddiffetent  bodies. 
This>  expressed  in  the  s{Mty,(^th  'coutia't1ipairi9.]^^  of  the  matrix' E  in  any 
deacrip^  .where  the  bodiM  ate  tttodelleil  separately.  lodeedi  in  e^  colntah  of  E  only  the 
tbiid  txriespoddini'to.veldciiy  paraiheieca'of  the  ooncensd  bodiea  are' occupied,'  Le.,-'at 
most  a'fiactud  ^tnindier  of  bo^Vof  the  r^' The  mbUpycuiaii  of  is  vector  with  either 
E  of  its  panapaae  can  be'coetipttwd  efBciently’takioii  advent  of  this  ipatai7. 

FiiriherttMce,^  ifae'qwrtio  can  be  used  to  reduce  the  coat  of  the  CSiOMky  tsctorisadoo  of 
the  tiiaarix  0  ■  E^A  E  ■  rT.R.  The.oonadalata  -U,  the  eplmnaa  of  E,-  are  teonknd  once 
aethe  be'gii^il  of  the  sitiailatiw  io  obiala  a’i^ne  fiicisr.R.  ^Thia  teoiderini  can  be  done 
using'  iwy: standi  alg(»iihi^*‘far.inataiibe  minii^  (9]t0r  lexicographic  [14] 

crd^iifs.’'At  Mch  evaiuatiao  of  the'right  haadlde  in  tte  ODE  ooe.has  then  to  proceed  to 
comipote,R  u^f  ,te'knm'spa^.tttuctBR;:tbia.cu'b^^  either  with  a  sparse 

Choletki^gotiAtti  ap(^  to  0,  or'tw  jy'oooepBtiiig  S.iqpafse  QR-decompotition  of  the 
maaix''^;(fcf;ituiuKe'sMtu''ajei^^row;attho|oiialiia^  [4]).  In  the 
second  oiae^'the  feotideting  of  the'fows  of  E  to  ledooe  conopwaiiooal  effort  baa  to  be 
done  only  once  at  the  heginaingtrf  the  anuilation, 

Already  in  the  feladvrly  st^  seven-body  mechaoiiai. described  in  [IS],  where  in  our 
descriptipo  .E  and  R  ate  opcopjM.lio.lSib^ipqiectively  37%.  the  conridetadoa  of  the 
sjiatsuy  ttdiioes  the  (bctotioiido'time  ^  a  ficir  of  about  four. 

By^  careful  :ex^tuionrof.the"s^ity'(Smictnrc.  it- is  to  be  expected  that  the 
cooputuiaiial  effon  sfUl  inm  lideatly  in  the'nmobcf  of  cbosniats  and  bodies  for  'typical' 
system:  [  the/actbr  R'caa  be  shown  to  be  full  in  any  sysieni  sriiete  one  body  it  connected 
to'evefy  other^b^.’so'  that  the  ^arie  fhetorisadoa  tnay  nor  be  advantageous  for  such 
systems).  A  direct  treunieatof  matrix  (13)  as  a  spm  uatrix  ^s  the  disad'/antage  that  the 
pivot  choice  coatpused  inilialiy  hu  to  be  mdnitornd'duting  the  fiictoitisatioo  to  insure  the 
stability  of  the  aigaritfaita  as  the  matrix  it  indefinite.  Recis^  elimcnatioo  [13],  a  linear- 
growth  algorithm,  is  applicable  to  systems  with  tree  structure;  loop-closing  constraintt 
have  to  be  treated  sepaiwy  in  other  systems. 


4.  DYNAMITE 
4.J  Basiefeaturts 

DYNAMITE  [3]  is  an  implementadon  of  dr  ptojectioo  method  for  the  descripdon  of 
muldoody  systems  u  desenbed  above,  in  particular  of  rormuiatioo  4.  To  meet  industrial 
needs,  this  basic  formulation  hu  been  extended  to  problems  with  tunc -dependent 
constraints,  with  sliding  friction  dependent  on  noa-w7tliing  constraint  farces  and  also  to 
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problems  of  inverse  Idnedcs.  Tte  iddiiioiuj  tlgbbr^  equations  for.tfae  Deanoent  of  sliding 
Mcto  are  minimi  in  nuinba  aM  of  in^  1  tw  ^  linear,  while  tbe  additioiial  algebraic 
equations  aused  biTinyrn'kitMties  are  lio&  and  of  index  1  even  when  die  imposed 
motion  is  strictly,  sansfi^  u  the  velMiy  level.  Hie  time-dependent  constraints  are  taken 
intoatcauhtin'the{TOjm<)iis.AusayqidnfaMtioiialequaiioiis.. 

‘DYNAhaTE'mue^:bdd^'separetely'^  uses  absolute  coordinates;  cartesian 
coordii^  of  the  Renter  of  ftiviiy  and  robuioii  angle  for  planar  systems.'and  caneaan 
cobtdihiiesaf  the  center  'bf  gr<^  and  tm.t^^yeciots  in  pind|ial.dimctiana'o{  inertia  for 

synns^The'd^uiyM  (tijhe  oqqniinm'ffiv'plaoar  system),  the  velocity  of  tte 
'C(i»)^'^viiv!^io[rampqn^^tf;tiiejqatial,syatera’and.ihesiotatioaal’.velocity  in 
coi^imEnts'or  the'  body  fixed  9«ei'  (for  syst^)  are  liaed  u  velod^  parrmetets. 
This  syttim  desciiptioa  satiste  cooditiou  of  section  3,  i.e.,  separate  neaiment  of  each 
body  a^  constuit  and  diagonal  niauj|natti(«s.;In-addition;to  that,  then  ate  other 
advantages  of  the  chosen  dMctiptica.  Thanks  to  the  separate  treatinent  of  each  body  using 
abiplute  cnoniinatM,  a  kinimtiral  analysis  prior  to  simiilalion  is  not  necessary  in  the  cate 
aY.$taticidly;de'tenmu^^sytKtiw;tbe  fotmulttidn'of;CoottTainu  and, forces  and  the 
calculation  tti  inertia  teraiu  are  tiniple  and  inexpensive;  tubsyttaint  are  easily  appenkd, 
deleted  or  iMdWed.  Futtfaamore,  the  cbordinatet  are  globally.defined  to  that  cooitilnate 
singttlaritioi'Be'avolded,"  '  ^  .  1 

'  The'clatt'  of  sysi^  thitt  can  be  timtilated  with  DYNAMITE  is  currently  restricted  to 
naiti^y  deennined  systm 

DYNAMITE  odbsita  of  three'maio  para: 

'  *  ‘TosZ-kfir  (one  feif  planar  ^tiema,  one  for.  spatial  systems):  bodies,  constraints, 
forces.  The  tool-kits  crM  numeii^  ludim  and  veemrs  to  describe  die  system 
(A,'£,'  C,''fi'etc.).:New~c(»sniott'df  forces  can  easily  be  appended  to  the  tool¬ 
kits  1^  the  iSer.  '  '  7 

•  Uneordiebra  process^  Fully  numerical,  system  independent  calculation  of  the 
equations  of  omtioni  Hk  liiw  algeln  ptbcMtcr  iratfcs  with  the  system  mntrices 
and  vectors  crested'.by  the  'io6i-ki&.Special;auentioa  bu-been  paid  to  the 
modulari^  n’simplifif  mainienanbe  and  genentiialioo. 

•  /ni(gr<Bors:LSOpARandpA»T 

DYNAhOTF.  is  a  joint  ^deyelopeiaeat  of  the  Swiss  Federal  Institute  of  Technology 
Zurah,  and  OefUkon:Contraves' Zurich;  it  is  sponsored  by  tbe  Commission  for  the 
Proantiott  of  Scientific  Resraich  of  the  Swiss  Fedenl  Departeiaeat  of  Economy. 

42  FmufeDevelopementt 

DYNAMlIE  wiil  be  extended  to  perform  parsmeier-sensitivity  analysis  iwith 
analyticaliy  'generated  sensitivity  matrices)  and  to  handle  small  and  large  elutic 
deformations.  Other  possible  extensions  are:  numerical  methods  for  statically  indetetmined 
systems,  adequate  methods  for  stiff  systems. 

43  Previous  Industrial  AppUaslons 

DYNAMITE  has  been  tested  on  theoretical  systems  and  on  the  two  standard  reference 
examples  in  [13].  It  has  also  been  applied  succes^y  to  industrial  problems; 

•  simulation  and  calculation  of  energy  coosunqition  of  a  Catling  gun 
(Oeriikon-Contraves,  Zurich) 
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^  isunulttun  of  a  low  voltage  drcuit  bmlOT '  _ 

(in  cbllatoin^aa  'inih'ABB  Ctepaae  Seaemlu  (31-Baden-DIUtwil:  see  next 
sectiob).  ' :  ' 

5.  Simulation. of  a  Low  Voltage'Cireull’Br^cr  wlih  DYNAMITE 
5 1  System  description  : 

'  llie'ineGiiaaiiiii'depidnlinHgmtiotliepoiisiao'clotrt  cooiimofsUfuutt(Nr. 
1-  to  6)'.iT1iey'in  intemoanaei^  tV  four  revolute  jo^ti  (D  ooimectt  3  and  4.'  E  connera  1 
and  3  and  F.  doonecti  4;'S.aml  dVIlnie  jointa  coonm  pans  of  the  mechanism  to 

tlieiacniid'sysaem'(AwiihT;Bwith2sndCwiifa3). 


Flgin  li  ClRiiii  bceakat  la  dia  ctornd  confiiandon 

Attached  to  body  2  is  a  manipubiioa  handle  10  farbf  the  ctedt  bleaker  from  the  poddon 
"open"  to  the  positiai  "closed”.  Body  6  is  the  uinsaiisibB  pan  between  the  ciscuit  contact 
f  and  the  win  attached  at  the  other  e^  of  this  body. 

Regions'.wilh'unitaml  coostiaioaKwIiete  ' impacts  can  occur  depending  on  the 
patimeier  values)  am  matlted  in  flg.  1  by  a.  b,  c,  d.  e  (0  is  a  system-fixd  bolt;  impacts 
with  0  can  occur  together  with  bidilies  2  and  3)  and  L  Regions  g  (bolt  H  is  pan  of  body  3) 
and  h  (when  a  h^  bolds  body  1)  an  otto  ngiou  of  itoaietal  conttnints.  The 
unilaieni  ooosniinn  e  (body  2),  f  and  g  am  acdvt  when  the  chcuit  is  closed  and  a,  b  and  e 
(body  3)  an  active  when  dM  chcuii  is  bratoL 

The  mschiuiism  bu  dues  degnes'of  freedom  nto  no  unilaicnl  oonsnint  is  active:  the 
angles  of  bodies  1 ;  5  and  d  defiM  frilly  the  bohfigtndod  of  the  mecLnnism. 

The  mechanism  contains  two  spiinp:  one  between  bodies  S  and  6  and  the  otto 
between  body  2  (point  I  in  Figun  1)  and  to  bolt  of  levolute  joint  D,  to  laner  being  to 

mailt  y  ^  |j|)Q 

The  mechanism  snys  in  to  dosed  iweitiott  as  ioogM  body  1  is  held  in  b  by  a  book. 
Taking  away  that  hook  itans  to  tninddoa  from  "dtod*  to  "open";  this  piocesa  takes  less 
then  0.04  second.  What  haniens  during  tids'traasitioh  can  be  described  roughly  as 
follows;  The  fbrce  of  to  elongated  main  teasioo  spring  acting  cn  joint  D  leads  via  body  3 
and  joint  E  to  a  toitiue  acting 'counterclockwiae  on  bo^  l.'Body  2  stays  in  its  initial 
posito  at  long  u  to  line  of  applicadoo  of  to  main  teasioo  spring  is  on  the  left  hand  side 
of  joint  B.  Bo^  3  tuns  clockwise  vjdl  to  line  of  ^tplicadon  of  to  main  teasioo  spring 
changes  from  to  left  hand  side  of  joint  E  to  the  right  hand  side;  it  then  tuns 
counterclockwise.  The  final  positioo  is  defined  by  to  activity  of  unilateral  joints  a.  b  and  e 
(body  3),  u  et^iained  above. 

52  Siimtitttion  and  Experiment 

Hgures  2  and  3  show  the  calculated  angles  of  bodies  3  sod  6  defining  together  the 
poridon  of  body  6  (winch  it  functtonallyielwtnt).  Figun  2  shows  also  the  experimentally 
determined  time  hisaxy  of  the  angle  of  body  3. 

Flgan  2:  Angle  at  body  S  (v).  expenacm  aad  annliiiai 
Figure  3:  Angle  of  body  6  (f).  iimalinfn 


S 
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The  simuiadon  is  based  on  panmew  values  detenmned  by  experiments.  Parameter 
vaiiadtms  and  vaiiadons  in  the  modellihf  of  dampmg,  friction  and  impacts  are  inipdnant 
when  studying  mlia^ty  of  the  calculaupns.  Thereby,  the  not  negligible  vatiadon  of  the 
inendon^  phenome^jn  u  well  u  the  complexity  of  the  mechanism  •  body  6  has 

no  fixsi  hinge  ;jiise  ^e^  (fiffieul^^>  ^ 

'  ^  Jlie'painKter  fitting  shd^  the  in^tatj^  of  Mosidviiy  analysis  which  wW  be  the 
nut  exteasicn  ’of  DYNAMTIS.  Thinla  to  its  feimses  -  espedally  the  matrix-structure  of 
the  equations  -.DYNAM^  is  ^-sui^  for  this  extensiam  In  the  developement  cycle, 
whoe  mihmizing  pntc^^g  tfarragh  leliabte  calculadohs  is  a  main  objecdve,  sensidvity 
analysis  pia^'  an  evra  moR  itnpdiiaat'nde  than  in  the  analysis  of  erisdng  mech^sms. 
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-Abstract.,  ,  :  , 

The  dvnamics  of  r.gid  multibodies  is  ^r^monslly  formulated  by  means  of  either  minimal  or  redun- 
dam  coordinates  methods.  An  alternative  approach  is  here  proposed  whereby  a  set  of  more  than 
redundant  coord  nates  is  adopted.  As  a  result,  the  equations  defining  the  constraints  and  the  motion 
of  the  bodies  are  decoupled,  many  physically  meaningful  response  variables  are  directly  available 
\shile  tne  constraint  conditions  are  imposed  in  a  verv  natural  way.  The  first  part  of  the  paper  pre¬ 
sents  the  basic  concepts  and  the  theoretical  developments  of  the  formulation  while  the  second  part 
develops  a  numerical  approximation  for  the  methodol<^  proposed  in  the  first  part.  The  nonlinear 
system  of  differential-algebrsic  equations  ruling  the  motion  of  the  system  is  written  in  its  weak  form 
and  solved  by  applying  a  ^’ewton•Raphsoa  procedure  to  a  finite  elements  approximation  in  the  time 
domain.  The  details  of  the  numerical  implementation  of  this  method  wiU  be  discussed  and  a  solution 
procedure  will  be  presented.  Some  numerical  examples  involving  tree  and  closed  loop  topologies  will 
finally  prove  the  capability  of  the  present  formulation  in  handling  multibody  dynamics. 

1  Introduction 

The  definition  of  general  purpose  algorithms  for  the  analysis  of  the  dynamics  of  rigid  multibodies 
represents  an  interesting  task  in  modern  computationid  mechanics.  The  literature  on  this  subject 
is  very  rich,  filling  any  aspect  of  the  problem  Various  approaches  have  been  proposed  to 
analyse  the  motion  of  a  moltibody  system.  Starting  from  a  common  set  of  primitive  equations,  the 
mechanical  system  can  be  described  in  its  state  space  by  means  of  a  set  of  Ordinary  Differential 
Equations  (ODE)  or  m  its  physical  space  by  means  of  a  set  of  Differential  Algebraic  Equations 
(DAE)  ^  In  the  first  family  one  finds  the  minimal  set  methods  and  in  the  second  the  redundant 
coordinates  methods  *'*®-*i'*^ 

This  paper  presents  a  new  formulation  to  face  the  dynamics  of  rigid  multibodies  starting  from  its 
basic  concepts  and  trying  to  explain  Its  most  innovattve  and  interesting  features.  In  the  development 
of  this  work  we  try  to  take  in  some  particularly  felt  requirements  In  multibody  dynamics.  At  first  we 
chose  to  have  at  disposal  a  wide  set  of  primary  unknowns  with  an  immediate  and  univocal  physical 
meaning  allowing  to  avoid  cumbersome  and  mathematically  sophisticated  pre  and  post  processings 
to  prepare  the  data  and  to  recover  interesting  design  parameters  Moreover  we  organise 

the  multibody  model  in  such  a  way  to  solve  many  different  problems  such  as  direct  and  inverse 
kinematic  and  dynamic  analysis,  control  system  design  and  stability  analysis  in  a  unified  framework. 
We  rearrange  the  equations  of  motion  to  obt^n  a  sigmficant  decoupling  between  the  bodies  and  the 
constraints,  thus  allowing  an  easy  exploitation  of  the  massive  parallelism  of  the  modern  hardware 
and  software  architectures 

To  this  end  we  develope  a  general  kinematic  analysis  to  stress  the  relation  between  the  absolute 
coordinates,  used  to  define  the  position  of  the  bodies,  and  the  relative  coordinates,  used  to  define 
the  reciprocal  position  of  two  constrained  bodies.  In  this  formulation  the  absolute  and  relative 
coordinates  are  considered  independent  parameters  constrained  by  a  kinematic  equation.  X  set  of 
new  unknown  vectors,  called  multipliers,  is  then  defined.  They  are  related  to  the  internal  forces  of  the 
constraints  as  the  momenta  are  related  to  the  external  forces  acting  on  a  free  body.  Two  interesting 
results  can  be  obtained  in  this  way.  The  muitipUers  permit  to  properly  define  the  modified  momenta 
and  to  write  the  equations  of  motion  of  a  constrained  rigid  body  as  those  of  a  free  body.  Moreover,  the 
aim  of  decoupling  the  equations  of  the  bodies  and  constriunts  is  reached,  the  multipliers  representing 
the  interface  between  the  elements  of  the  multibody  system.  The  decoupling  is  shown  also  by  a 
variational  principle  ruling  the  motion  of  a  multibody  system  in  Lagrangian  form.  The  availability 
of  the  re!ati%-e  coordinates  and  of  the  internal  forces  allows  a  natural  and  easy  imposition  of  the 


I'onstraims  and  a  direct  evaluation  of  these  two  parameters  that  are  basics  in  the  design  of  control 
s\  stems. 

2  Kinematic  Analysis 

The  linematic  model  of  the  elementary  multibody  system  presented  m  Figure  1  and  consisting  in 
tTO  constrained  rigid  bodies  will  be  here  outbned  and  analysed.  The  origin  of  an  Inertial  Reference 
Frame  (IRF)  IS  placed  at  the  point  O.  those  of  two  Embedded  Reference  Frames  (ERF)  at  the  points 
P,  and  P,  and  the  points  of  the  bodies  where  the  constraints  are  applied  will  be  called  Q  and  <}  . 
.\  set  of  lagrangian  coordinates  for  the  rigid  bodies  can  be  obtained  by  joining  the  position  vectors 
of  the  reference  points  P,  and  P,  and  the  finite  rotation  vectors  p,  and  p,  that  rotate  the  bodies 
with  respect  to  a  reference  configuration.  They  can  be  summarized  by  using  the  enlarged  vectors 
(e.f.)  notation  asi 

«'e.  =  (“..<>.)  '“l-i 

'.  ratutal  set  of  relative  coordinates  is  formed  by  the  distance  vector «  which  connects  the  constrained 
points  and  <},  and  by  a  properly  defined  relative  rotation  p. 

?*  =  («.P) 

The  absolute  and  relative  position  e.v  ate  represented  with  a  notation  that  will  be  maintained  fur 
some  other  enlarged  vectors.  The  symbol  at  the  tight  upper  cornet  represents  either  the  body  to 
which  the  vector  is  referred,  if  it  is  a  number,  or  a  relative  parameter  if  it  is  R.  The  symbol  at  the 
light  lower  corner  represents  the  point  to  which  the  enlarged  vector  is  referred.  Two  equations  can 
be  Slated  lo  relate  the  relative  coordinates  to  the  bodies: 


6.  =  6.  J-e  H{p,)  =  Jl(p)ii(p,)  (1) 

in  which  ft(p,),  il(p,)  and  R(,p)  ate  the  rotation  matrices  associated  to  the  rotation  vectors  p  , 
p,  and  p.  It  must  be  noted  that  the  use  of  the  finite  rotation  vector  to  parametrize  the  rotation 
group  50  (3)  IS  not  the  only  possibihty  and  several  alternatives  have  been  proposed  “  The  relative 
linear  velocity  measured  at  the  points  4,  and  4,  can  be  defined  by 

1  1  ,  a  1  1  a 

'oi  ='’oi+'’oi  'or  ='’oi+’’o.  (^) 

manipulating  which  it  is  not  difficult  to  prove: 


ad  ad 


(3) 


In  the  above  equation  and  in  the  followings  the  symbol  ^represents  the  relative  time  derivative  or 
variation.  i.e.  as  evaluated  by  an  observer  embedded  in  the  ith  body. 

The  defimtion  of  a  relative  angular  velocity  is  less  problematic  than  that  of  the  linear  one  because 
of  Its  independence  from  the  choice  of  the  reference  point  It  can  thus  be  consistently  defined  as. 


A 


(4) 


which  can  b«  manipulated  to  obtain: 


ftf  sci; 


.  J'"  jO 

V  =r(p,^p=r^p,^p 

Some  parametiizat'ons  of  the  matrix  P  arc  presented  in  References  20  and  21.  A  relative  velocitv 
€.v.  can  be  def.ned  by  stacking  the  above  deftmtions: 

K  /«  /d®  rt  \  v/  ^ 

“«  =  ^  («».) 

=  ('si--  )  =  =-^  (««) 

These  two  vectors  can  be  related  by  means  of  the  transport  operator  E  associated  to  the  relative 
displacement  e: 


A  «r  A 
to  s  £  lo 

Morwvet.  mdicitinj  by  u>]j,  ind  the  velocity  e.v.  of  the  bodies; 

“o.  =  ««.  =  «.•"  ) 

the  kinematic  equation  for  the  constraint  can  be  stated  by: 

*  r«^  *  *  ft  it\ 

3  Differential  Formulation 

The  equations  of  motion  of  each  constrained  ri^d  body  can  be  written  using  Euler  equations: 

Po,+S.K.)Po.-<Ji.-‘?o.='>  (6) 

In  which  p  represents  the  momenta  e.v.,  i.e..  the  vector  formed  by  the  linear  and  angular  momentum 
of  eacn  body,  w  is  the  velocity  e.v.  formed  by  the  linear  and  angular  velocity,  Q  and  Q  are  the 
externa]  and  internal  forces  e.v.,  i.e.,  the  vectors  formed  by  the  resultant  force  and  torque. 

The  internal  forces  e.v.  on  the  two  bodies  are  related  by  the  equation: 


The  vectors  Q  appear  explicitly  in  the  Euler  equations  to  couple  the  equations  of  the  bodies.  Some 
elements  can  be  deftned  to  allow  the  decoupling  of  the  Euler  equations.  In  fact,  if  the  bodies  were 
unconstrained,  their  equations  would  have  been  written  as: 

Pq. 

This  fact  suggests  to  dehne  the  multipliers  and  A^,  which  are  related  to  the  internal  forces  as 
momenta  are  to  the  externid  force.  1  e  : 


I 


'^ubstiiuting  equation  td)  into  equation  (6)  it  seems  natural  to  define  the  mouified  momenta  e.i-.s 


and  to  write  equations  16)  in  the  form: 

=0  (9) 

Equations  (8)  can  be  substituted  into  equation  (7);  thus  establishing  a  linkage  between  the  two 
multipliers.  The  result  can  be  manipulated  to  obtain: 

i  (a‘.  +  £>’,)  T  5,(»',.)  (a‘,  +  E>.l,)  =0  (10) 

Equation  (10)  is  fulfilled  by  setting: 


The  above  equation  suggests  a  transport  law  for  the  multipliers  analogous  to  that  used  for  the 
momenta.  Moreover,  starting  from  equation  (U)  and  enforcing  the  definitions  of  the  mutipliers. 
equation  (7)  can  be  obtained.  This  means  that  the  set  of  equations  t8)  and  (U)  is  fully  equivalent  to 
equation  (7).  Equations  (9)  can  be  referred  to  the  reference  points  and  P^,  the  modified  Euler 
equations  can  thus  be  obtained: 

p,.  +  s,(v\,)p\,-q'„  =  o  (12) 

The  multipliers  A^,  and  A^,, ,  referred  to  the  points  Pi  and  P,,  can  now  be  linked  by  applying  the 
transport  operators  to  equation  (U);  thus  obtaining: 

A;,+HA’„=0  (U) 

The  matrix  II  being  the  transport  operator  associated  to  the  distance  vector* 


h  =  c, +«-€,  =  Pj-P, 

Some  interesting  results  have  been  obtained  substituting  the  set  of  equations  (6)  and  (7)  with  that  of 
equations  (8),  (12)  and  (13).  The  equations  of  motion  of  each  constrained  rigid  body  can  be  written 
in  the  same  way  as  those  of  the  corresponding  free  body  by  exchanging  the  ordinary  momenta  with 
the  modified  ones;  thus  decoupling  the  equations  of  the  constrained  bodies.  The  above  defimtions 
of  the  modified  momenta  permit  to  project  the  Euler  equations  onto  some  directions  of  the  phase 
space  This  projections  have  the  property  to  free  the  modified  momenta  from  any  constraint. 

On  the  other  hand  the  action  of  the  constraint  has  been  explicitly  charged  only  onto  equations  (8) 
and  (13)  thus  leaving  equation  (12)  unrelated  to  any  constraint. 

.'X  decoupling  between  the  bodies  can  now  be  attempted  also  for  equation  (5)  ruling  the  kinematics 
of  the  system  through  the  constraint.  To  this  end.  let  us  refer  the  kinematic  equation  to  the  points 
Pj  and  Pj  • 


ihe  maujx  Cj  being  the  transport  operator  associated  to  the  distance  vector  c,  A  new  unknown  i/ 
can  be  defined  bv 

and  tne  kinematic  equation  through  the  constraint  can  be  written  as: 

j  ,,r  K 

v-C,  u,,,  =0 

To  complete  the  system  of  DAE  ruling  the  notion  of  the  muliibody  system  the  constitutive  equation 
of  the  constraint  must  be  added.  ThU  equation  has  the  form: 

and  cannot  be  further  specified  without  entering  into  the  details  of  each  constraint. 

4  Variational  Principles 

Tli«  urn  o(  this  puagttph  is  lo  d«v«lop  a  vanational  prisciple  governing  the  motion  of  a  multibody 
system.  The  starting  point  wiU  be  the  system  of  DAE  equations  previously  discussed  and  summarised 
in  its  most  general  form  below,  i.e.: 


^|..  +  5,(W,.)P^-Q’,.  =0 

(15) 

A',.+HAk=0 

(16) 

(IT) 

(18) 

(19) 

(20) 

(21) 

Equation  (21)  is  the  constitutive  equation  of  the  rigid  bodies  and  wiU  be  considereu  only  in  the 
Hamiitoman  form.  Its  role  is  to  establish  a  linkage  between  the  velocity  u  and  u  defined  by: 

=  K.  f,. 

in  which  represents  the  6  x  6  mass  matrix  of  the  itb  body.  The  variational  principles  wtU  be 
achieved  by  multiplying  the  equations  of  the  system  by  proper  weight  functions  and  combining  them 
linearly.  In  a  Lagrangian  approach  not  all  the  equations  and  unknowns  will  he  held.  .As  a  matter  cf 
fact,  the  constituti\*e  equations  (21)  will  be  considered  as  satisfied  a  pnori.  The  momenta  c.v.  wul 
not  be  considered  as  a  primary  unknown  but  simply  recovered  a  posteriori  by  multiplying  the  mass 


mairix  by  the  velocity.  The  velocity  e.t\  is  related  only  to  the  time  derivative  of  the  Lagranaian 
coor<^inate  e.v..  so  that,  no  difference  exists  bet^^een  the  velocity  e  v.  w  and  w  Equation  f  lo)  can 
he  kalariy  multiplied  by  the  pseudo«vanation  of  the  Ugrangian  coordinates  : 


This  equation  can  be  manipulated  by  applying  the  product  differentiation  rule  and  writing  q'^^,  as 
depending  from  thus  obtaining: 

jj  -  I'f.fi'-- = “  < 

The  lagrangian  function  of  a  rigid  body  subjected  to  non  conservative  forces,  can  be  written: 

c.  = 

The  second  term  of  equation  (i2)  suggests  to  define  a  modified  Lagrangian  function: 

and  to  evaluate  its  variation: 

This  definitioas  can  be  introduced  into  equation  (22)  obtaining  the  variational  form  of  the  Euler 
equations. 


i  =  0  (23) 

The  variational  form  for  the  diffetential  system  will  be  obtained  by  summing  equations  (23)  wuh 
equations  ( 16)*(20)  scalaily  multiplied  by  the  funct’ons  and  qj,  Applying  the 

product  differentiation  rule  to  all  the  terms  containing  an  explicit  time  derivative  ot  the  unknowns 
and  by  manipulating  the  linear  combination  we  can  write: 

d  /  I  ,i  ,  1  .j  a  .j  \ 

d(  X 

-2  (£,  +  4  +  ’^n)  •'«)  + 

+  sUjf\>  A*„  =  0  (24) 

It  IS  interesting  t^/  note  that,  although  from  a  mathematical  point  of  view  the  weight  functions 
must  be  independent  in  general  sense,  this  independence  is  not  completely  arbitrary  if  a  mechanical 
meaning  is  assigned  to  them.  In  fact,  the  last  row  of  equation  (24)  must  be  zero  if  the  kinematic 
consistenc  /  of  the  virtual  dispUcensents  must  be  conserved.  Some  interesting  remarks  can  be  made 
on  this  variational  form  At  first  it  must  be  noticed  that,  substituting  the  ord.nary  lagrangian 
functions  and  momenta  e  v  with  the  modified  ones,  the  contnbution  of  each  of  the  constrained  rigid 


bodiW'is  the  same  as  that  of  a  free  body*,  i  e..  the  sum  of  the  boundary  term,  of  the  variation  of  the 
Lagrangian  function  and  of  the  virtual  work  of  the  extern^  forces.  Moreover,  'he  constraint  appears 
into  the  equation  as  a  mechanical  element  characterised  by  a  boundary  and  virtual  work  term  for 
which  the  role  of  the  Lagrangian  coordinates  is  played  by  the  relative  coordinates:  that  of  external 
forces  by  the  internal  forces  and  that  of  momenta  by  the  constraint  multipliers.  The  Laijrangian 
function  cannot  be  defined  for  the  constraint  because  it  has  no  mass.  The  term  corresponding  to  the 
vanauor.  of  the  Lagrangian  function  has  been  introduced  in  Routh's  form:  i.e..  as  the  product  of  the 
generali!i«d  momenta  e.u..  i.e.  the  multipliers,  with  the  correspondent  generalised  velocity  ^.v, 

.\  similar  principle  can  be  obtained  by  operating  on  the  Hamiltonian  form  of  the  system  of  DAE  and 
it  is  not  reported  here  for  sake  of  brevity. 


5  Linearized  Weak  Form 


The  weak  form  of  the  system  of  DAE  is  obtained  by  integrating  over  the  time  domain  [ti « tj]  C  A  the 
dot  product  of  the  equations  of  motion  in  Hamiltonian  form  by  some  arbitrary  test  functions  v  € 
Integrating  by  parts  until  all  the  time  derivatives  are  wholly  charged  upon  the  test  functions: 


/"  ( E  (s  -  <Jf,) + (9,,)  + 

+<'.  {K,  +  *.  K>  -  ■')  + 

(^"  K) « -  •*"  (««)  + 

[e  + ’’W’,.) + '.d,  -  («) 

To  introduce  the  numerical  approximation,  we  write  the  weak  form  (25)  in  a  more  abstract  wav.  To 
this  end,  let  us  call  V  the  vector  formed  by  all  the  test  functions  and  by  their  time  derivatives,  J  (u) 
the  vector  gathering  all  the  functions  multiplied  by  them  and  5  the  scalar  function  containing  ail 
the  terms  at  the  boundary  of  the  time  domun.  Equation  (25)  can  thus  be  written: 


£'vj(u)d(  =  (ei;;  m 

The  test  functions  appear  into  equation  (26)  with  their  time  derivatives  and  the  trial  functions  appear 
through  the  vector  J’(u)  without  any  time  derivative.  A  pc'uible  choice  of  the  space  of  the  test 
functions  could  be: 


V  :=  (1) ;  r  6  H’  ((„«,)}  U  :=  {«(() :  u  6  ((,, ;,)} 

With  appropriate  boundary  conditions  for  the  unknowns  which  are  defined  on  the  boundary.  V  C 
V  and  this  fact  will  permit,  as  shown  m  the  next  paragraph,  the  use  of  two  different  numerical 
approximations  for  the  test  and  trial  functions. 

The  weak  form  (26)  is  Eneariy  dependent  upon  the  test  functions  and  their  derivatives  and  it  is  non 
linearly  dependent  upon  the  unknown  vector  u.  In  order  to  apply  the  finite  elements  in  time,  the 


form  (26)  must  t>«  ^^ntten  as  a  bilinear  form  m  the  test  and  trial  functions.  To  this  end.  vve  . 
linearize  the  vector  y  («)  around  a  reference  condition  w.  It  is  noted  that  B  does  not  need  to  be 
linearized 


rvs{u)dt=  rvj(u)dt+  rVT{u)dudt+  f'vidt  (27) 

Jii  Jtt  Ju  ■'tt 

T  f  u)  IS  the  jacobian  matrix  of  the  vector  J  (u)  evaluated  at  u.  du  is  the  increment  of  the  unknowns 
and  s  all  the  terms  that  will  be  neglected.  The  incremental  equation  can  be  obtained  by  substituting 
equation  (27)  into  (26)  and  omitting  ail  the  aegUgible  terms. 


jf"  vr{3)du*  =  (ej;;  -  j'"  vj{u)dt 


m 


6  Numerical  Approximation 

The  aim  of  this  paragraph  is  to  introduce  a  numerical  discretization  and  to  describe  the  solution 
algorithm  for  a  typical  initial  value  problem.  The  vector  V  in  equation  (28)  is  ordered  with  th* 
test  functions  followed  by  their  time  derivatives.  The  matrices  T  (u)  and  J  (5)  axe  then  orderea 
consequently.  Thus,  indicating  with  T,  (C)  and  (H)  the  blocks  of  T  (C)  and  J  (U)  multiplied  by 
the  test  functions  and  with  T,  (5)  and  J*,  (H)  those  multiplied  by  their  time  derivatives,  equation 
(28)  becomes: 


iudt  a 


(29) 


In  this  equation  we  apply  the  Anite  elements  approximation  after  dividing  the  time  domain  (fiit)] 
m  n  time  finite  elements.  The  test  and  the  trial  functions  v  and  u  are  then  written  as. 


in  which  V  and  U  represent  the  vectors  of  the  test  and  unknown  functions  at  the  nodes.  and 
are  basis  in  the  spaces  S  if  and  C  K  in  which  the  approximated  problem  is  solved.  If  a 
polynomial  approximation  is  used,  the  spaces  and  are  snbspaces  of  the  space  of  the  *:th 
order  polynomials.  As  shown  in  the  last  paragraph,  the  functions  can  be  Isf  order  polynomials 
at  least,  i.e.  piecewise  linear  functions.  can  instead  be  0  order  polynomials  at  least,  i  e.  piecewise 
constants.  The  number  of  nodes  Ny  defining  the  test  functions  (at  least  two)  and  those  Ny  used 
for  the  unknowns  (at  least  one)  can  thus  be  related  by: 


Ny  -Ny-¥\ 


Substituting  such  an  approximation  into  equation  (29),  it  becomes: 


(20) 


Oa  the  other  hand,  the  shape  (unctions  that  multiply  the  terms  u,  are  non  zero  only  at  the  two 
external  nodes  The  boundary  terms  can  thus  be  wmten: 


-I  0  (  \ 

0  0  (,U) 

0  /  J  I  ““  i 

Indicating  'Aith  n^.  the  number  of  unknowns  and  with  the  unknowns  defined  at  the  boundaries. 
/  a  unit  diagonal  matrix  with  rows,  the  central  block  is  formed  by  n^.  (n>  U  null  rows. 
Substituting  equation  <31)  into  130): 


dt  (32) 


for  a  typical  initial  value  problem  equation  (32)  represents  a  system  of  linear  equations  in  the 
unknowns  dU  and  with  known  terms  deftned  by  the  first  boundary  condition  and  by  the  tentative 
solution  u.  The  linear  system  can  thus  be  written  in  the  form: 


We  observe  that  the  upper  block  of  equations  m  (33)  is  not  affected  by  the  unknowns  but  only 
by  dU.  This  fact  suggests  an  iterative  solution  algorithm.  Stuting  from  a  trial  solution  the 
increment  dU  can  be  evaluated  by  solving  the  upper  side  of  the  linear  system  (33).  The  solution  is 
updated  at  any  iteration: 


=C/,+dCf 

becomes  the  new  reference  solution  to  evaluate  the  tang^n  matrix  IC  and  the  residual  vector 
H.  Once  the  convergence  is  reached,  the  increment  dU  is  considered  negligible.  In  such  a  way.  it 
cannot  affect  the  lower  side  of  system  (33)  and  the  final  boundary  condition  can  be  directly  recovered 
by: 


I 

I 

i 


u„=-'R,(l/.,.)  (34) 

This  procedure  can  be  applied  in  the  assembled  form  on  the  time  domain  [tt ,  t?)  or  in  the  incremental 
form  on  the  single  time  finite  element  (f* ,  j.  In  this  case  the  final  boundary  condition  becomes  the 
initial  one  for  the  successive  time  step.  It  must  also  be  observed  that  not  all  of  the  unknowns  have 
boundary  terms,  in  fact,  the  vectors  ,  v  and  have  only  internal  values.  On  the  other  hand, 
not  all  the  equations  are  integrated  by  part  so  that  the  balance  between  equations  and  unknowns  is 
conserved.  Considering  a  general  multibody  system  formed  by  N g  bodies  and  constraints,  the 
total  number  of  internal  and  boundary  unknowns  is  the  ^ven  by: 


N=:6’i2-NyNgT2-NyN^^Z-N„N^)  (35) 

It  should  be  remarked  that  the  subsequent  examples  have  been  earned  out  by  assuming  Nf;  =  I 
and  Ny  =  2:  this  should  be  undersloot.  even  if  it  i$  not  expbcitly  stated. 


7  Sparse  Matrix  Techniques 

EquatTon  (03)  makes  it  clear  that  the  advantages  of  a  more  than  redundant  formulation  implies  a 
heavj  cost  in  term  of  the  number  of  unknowns.  This  fact  does  not  implies  a  correspondent  increase 
m  computer  cost  because  of  the  high  sparsity  of  the  resulting  nonlinear  system  of  equations.  In 
fact,  most  of  the  equations  are  nothing  more  than  mete  definitions  adopted  to  allow  the  decoupling 
of  the  equations  and  are  thus  rohwd  just  to  few  unknowns..  Moreover  their  elimination  during  the 
solution,  e.g.  through  a  factorization,  requires  my  few, Editions  and  multiplications  and  maintains 
the  sparsity  of  the  system  since  it  introduces  new  terms  whose  numberis  of  the  order  of  the  directly 
connected  bodies.  It  should  be  sufficient  to  note  that  the  muitibody  system  presented  in  Example  2.2 
requires  1032  unknowns.  372  of  which  are  recover^  a  ^teriori  as  boundary  terms  by  means  of 
equation  (34).  The  remaining  660  unknowns  present  a  sparsity  of  .81  per  cent  that,  after  the 
factorization,  becomes  of  1.15  per  cent.  It  1$  noted  that  the  approach  presented  m  this  paper  has 
many  similarities  with  the  tableau  techniques  adopted  in  electrical  circuits  analysis  Thus,  despite 
the  large  number  of  unknowns,  the  more  than  redundant  ordinates  formulation  can  be  treated 
efficiently  by  the  adoption  of  sparse  solvers  of  the  same  type  used  for  circuits  analysis  In  the 
implementation  of  the  present  formulation  the  solver  has  been  taken  from  Reference  29  and  the 
assembling  of  the  sparse  system  has  been  programmed  anew  through  an  efficient  implementation 
of  the  hashing  techniques  found  in  the  same  reference.  Hashing  is  quite  effective  since,  because  of 
the  spare  memory  that  must  conservatively  be  kept  in  view  of  the  611  In  during  the  factorization, 
the  working  core  space  can  be  allocated  once  for  all  and  the  probability  of  different  matrix  terms 
colliding  is  very  rare. 

It  can  be  Interesting  to  note  that,  since  the  assembly  and  solution  time  is  negligible  with  respect 
to  that  of  setting  up  the  equations,  it  is  easy  to  implement  the  present  formulation  on  parallel 
computers.  In  such  a  cue  the  equations  of  the  different  bodies  and  constraints  can  be  evaluated 
independently  on  the  available  CPUs  without  any  need  of  synchronisation.  The  assembly  can  also  be 
easily  paralleled  by  pre  assembling  the  elements  to  be  processed  by  each  CPU.  The  only  operations  to 
be  performed  in  series  are  the  Anal  assen.  .lies  of  the  sub  blocks  and  the  solutions  which,  as  previously 
noted,  are  of  negligible  cost.  It  is  furthermore  noted  that  what  said  above  is  applicable  both  in  case 
of  shared  and  dedicated  central  memory  as  communication  and/or  synchronisation  of  the  different 
CPUs  is  required  only  dunng  the  Anal  phase. 

8  Numerical  Examples 

In  order  to  prove  the  capability  of  the  present  method  in  handling  complex  problems  in  rigid  multi* 
body  dynamics,  some  examples  have  been  considered.  The  results  will  be  discussed  and  compared 
to  those  available  in  the  bterature  as  well  as  to  those  obtained  by  using  the  multibody  program 
ADAMS  \ 

8.1  Example  1:  The  BIpendulum 

We  have  considered  the  motion  of  the  bipendulum  of  Figure  2  whose  geometncal  and  inertial  pro¬ 
perties  are  reported  in  Table  1.  At  time  r  =  0  the  two  bars  are  aligned  on  the  negative  y  axis  and 
rotate  with  an  angular  velocity  of  4  rad/s  around  the  z  axis.  Two  different  conAgurav.ons  have  been 
tested  considering  different  combinations  of  joints. 

In  Example  Ji  I  the  bars  are  linked  by  sphencsf  joints  and  the  result  is  a  very  complex  three  dimen¬ 
sional  motion  because  of  the  combination  of  the  weight,  centrifugal  and  gyroscopic  forces.  Figure  3 


presents  tKe  cross  plot  of  the  coordinates  x.  y  of  the  centre  of  mass  yCoM )  of  the  two  bars  and  allows 
to  appreciate  the  perfect  accordance  between  these  results  and  those  uken  from  the  literature 
In  Example  1.2  bar  1  is  connected  to  the  IRF  by  means  of  a  constraint  that  enforces  the  component 
of  the  relative  angular  velocity  along  tKe  z  axis  to  constant.  The  linkage  between  bars  i  and  2. 
instead,  is  constituted  by  a  damped  hinge  with  an  hinge  axis  parallel  to  the  x  direction  at  time  t  =  0 
and  embedded  into  body  1.  The  motion  of  bar  2  is  a  damped  oscillation  into  the  plane  y:  till  a 
position  is  reached  in  which'the  inertia  forces  balance  the  weight.  Such  a  position  can  be  evaluated 
by<solying  a  problem  with  a  single  degree  of  freedom.  Figure  4  presents  the  time  history  of  the 
:  coordinate  of  the  CoM  of  bar  '2  for  some  values  of  the  dunping  coefficients  e.  Despite  the  lack 
of  comparisons,  the  configuration  of  dynsunic  equilibrium  and  the  behaviour  of  the  system  at  the 
changing  of  the  damping  coefficient,  have  b^n  venhed  to  be  correct. 

8.2  The  Fifteen  Links  Chain 

These  examples  have. been  taken  from  a  classical  test  case  of  multibody  dynamics,  i.e.  the  fifteen 
links  chain  of  Figure  S.  Each  link  of  the  chaia  is  a  bat  as  in  the  previous  example  and  the  joints 
between  the  links  have  been  modelled  by  means  of  spherical  joints.  In  the  initial  configuration  the 
chain  is  suspended  at  points  1, 6, 1 1  and  16  and  it  is  then  left  to  fall  unhooking  some  of  the  suspension 
points. 

in  Example  2.1  the  chain  falls  suspended  only  at  point  1  for  1.5  seconds.  Figure  6  presents  \'it 
animation  of  the  fall  while  Figure  7  presents  the  time  history  of  the  r  coordinate  of  the  CoM  of  bars 
3,$,  13.  Figure  $  presents  the  time  history  of  the  norm  of  the  internal  force  in  joint  8.  The  results  are 
in  accordance  with  both  those  in  the  reported  literature^***  and  with  those  given  by  ADAMS.  The 
action  of  the  constraints  is  progressively  extended  from  the  left  to  the  right  of  the  chain.  Each  link 
falls  substantially  free,  the  x  coordinates  describe  the  same  parabola,  till  the  left  side  neighbouring 
recalls  It  in  an  almost  impulsive  way  as  shown  by  the  peaks  in  the  constriunt  reaction. 

In  Example  2.2  the  chain  falls  suspended  at  points  1  and  16  for  0.5  seconds  and  the  bars  I  and 
15  are  enforced  to  rotate  counter  clockwise  around  the  x  axis  with  a  constant  angular  velocity  of 
*20  rad/s.  The  problem,  without  any  companson  in  the  literature,  constitutes  a  tough  test  for  the 
robustness  of  the  method.  Figures  9a  presents  the  animation  of  the  chain  in  the  time  interval  from 
0  to  .16  seconds.  The  boks  of  the  side  arches  rotate  and  press  on  the  mid  arch,  thus  slackening  the 
falls  of  its  links,  as  shown  by  Figure  10.  Figures  9b  presents  the  animation  during  the  time  interval 
from  .16  to  .33  seconds,  in  which  the  elements  of  the  middle  arch  are  sharply  tlong  up.  The  time 
history  of  the  CoM  of  bar  8  presents  an  angulai'  point  and  a  strong  increase  of  the  slope.  Figures  9c 
preseats  the  motion  m  the  time  interval  from  .33  to  ,5  seconds.  The  elements  of  the  side  arches  are 
folded  and  rotate  around  the  points  I  and  16;  thus  tightening  the  chain.  !t  must  ht  emphasised  that 
the  exampW  have  been  corri^  out  as  three  dimensional  simulations,  although  Example  1.2  presents 
an  axial  symmetry  and  examples  2  present  planar  motion.  This  fact  has  permitted  to  verify  the 
robustness  of  the  algonthm  in  conserving  some  geometnc  properties  as  planaril)’  or  symmetry.  The 
results  are  in  accordance  with  those  of  the  ADAMS  simulation  during  the  first  phase.  The  angular 
point  on  the  bottom  of  the  trajectory  is  slightly  shifted  but  the  flung  up  presents  the  same  slope 
No  folding  IS  observed  for  the  elements  of  the  external  arches  and  thus,  those  of  the  central,  present 
a  wide  oscillation  without  to  be  tightened.  It  must  be  observed  that  discrepancies  emerged  only  for 
symmetric  problems,  in  which  the  motion  is  so  coaslncted  to  present  significant  bifurcations  in  the 
unknowns  space.  In  these  situations  the  behaviour  of  the  system  is  difficult  to  be  predicted  because 
of  the  non  linearities  and  appears  to  be  intimately  related  to  the  numencal  approximation  and  to 
the  solution  algonthm. 


9  Concluding  Remarks 

In  fhis  uork  presenied  a  general  alk»tmhm  for  the  dynamic  analysis  of  rigid  muliibody  systems.  The 
Theoretical  analysis  of  the  kinematic  and  dvnamic  models  permitted  to  set  the  problem  in  an  effective 
'forking  frame.  Starting  from  the  system  of  differential-^gebraic  equations,  a  variational  principle 
as  developed  that  allowed  an  interpretation  of  the  present  work  from  the  classical  point  of  view  of 
analytictdjmechamcs.  A  proper  definition  of  the  multipliers  allowed  to  achieve  the  double  aim  of  an 
intrinsic  stabiUsatron  of  the  cdiistr^nts.  even  in  presence  of  numerically  stiff  problems,  and  a  total 
decoupling  of  the  equations  of  the  bodies  and.ths  constraints.  This  decoupling.can  be  profitably 
and  easily  exploited  if  parallel  computation  techniques  can  be  appbed  to  increase  the  efficiency  of 
the  method.  The  use  of  relative  coordinates  and  of  internal  forces  makes  it  natural  the  imposition 
of  many  and  different  constraints:  thus  perimttiog  an  easy  development  of  a  wide  constraints  library 
as  requested  by  multibody  dynamics.  On  the  other  hand,  despite  the  large  number  of  unknowns 
and  equations,  an  efficient  solution  has  been  achieved  by  the  adoption  of  a  sparse  solver.  .Moreover, 
the  present  work  provides  a  sound  basis  for  a  further  development  of  the  method.  In  this  view,  th-* 
addition  of  deformable  elements  and  active  control  techniques  seem  to  be  the  most  significant. 
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ABSTRACT.  Tljis  paper  presents  «n  efficient  algorithm  based  on  velocity  innsfonnauons  for  real>iime 
dynamic  simuiauon  of  multibody  systems.  CIosed«loop  systems  are  turned  into  open>loop  systems  by 
cutting  joints.  The  closure  conditions  of  the  cut  j'oints  are  imposed  oy  explicit  constraint  equauons.  An 
algorithm  for  real*iime  simulation  is  printed  that  is  well  suited  for  parallel  processing.  The  most 
computationally  demanding  tasks  are  matrix  and  vector  producu  that  may  be  computed  in  part^el  for  each 
body.  Four  examples  are  presented  that  Uiusuate  the  performance  of  the  method. 


1.  Introduction 

Real'time  simulation  is  becoming  steadily  more  important.  With  the  appearance  of  the  first 
digital  computers  the  challenge  of  simulating  muUlbody  systems  started.  The  first  challenge  was 
to  develop  general  and  robust  formulations  well  suited  for  computer  implememation.  Several 
multibody  software  programs  were  developed  as  a  result  of  these  investigations.  Most  of  them 
are  described  in  Schiehlen  (1990).  From  the  sixties  to  the  late  eighties,  the  programs  were 
steadily  improved  by  adding  new  capabilities.  Nowadays,  the  muldbody  simulation  programs  are 
power^  and  versatile  tools,  able  to  carry  out  simulations  of  systems  with  all  kinds  of  joints  and 
subject  to  any  type  of  applied  forces.  Fuithennore.  they  include  interfaces  with  CAD.  finite 
element  and  animation  programs.  However,  many  of  these  programs  have  sacnficed  efficiency 
on  behalf  of  generality  and  versablity. 

Real'time  multibody  simulation  is  the  starting  point  for  man«in'the-Ioop  simulators  and 
hardware*in*the*loop  testing  and  design  set-ups.  To  achieve  real-time  behavior  it  is  necessary  to 
have  a  sufr.ciently  fast  computer  but  also  an  efficietu  numerical  algonihm.  Processor  speeds  are 
increasing  by  a  factor  of  3  in  only  a  few  yea.'s  and  at  the  same  ume  processors’  architecrures  are 
evolving  incessantly.  However,  formulating  and  solving  the  dynamics  of  multibody  systems  is  an 
inherently  complex  task  that  requires  very  efficiently  and  well-implemented  aJgonthms. 

A  thorough  survey  of  dynamic  fonnulations  for  serial  ngid  body  multibody  systems  is  given 
by  Jain  (1991).  Fonnulauons  whose  complexity  grows  linearty  with  the  number  of  degrees  of 
freedom  are  called  0(N)  formulations,  Jain  (1991)  reviews  most  of  the  0(N),  O(ffi)  and 
formulations  and  gives  a  unified  approach  for  senal  open-loop  systems.  Well-known 
formulations,  such  as  those  developed  by  Walker  and  Onn  (1982)  Featherstone  (1987), 


Figure  I.  Open ctuinmulubody  system. 


Armstrong  (1979),  Bae  and  Haug  (1937)  and  Rosenllial  (1987),  are  among  tlie  (ormulaiions 
reviewed, 

Fijany  and  Beczy  (1990)  presented  an  improved  version  of  Wallcer  and  Onn's  (1982)  O(tfl) 
method  and  developed  an  algotithm  well  suited  for  parallel  implemenuilon  on  massively  parallel 
computers. 

Bae  and  Haug  (1987)  presented  a  genetaliuuon  of  Feathetstone's  0(N)  method  for  systems 
with  all  types  of  joints.  Bae  et  al  (1988)  showed  the  potential  of  this  method  for  parallel 
processing.  Chang  and  Kim  (1989)  used  this  method  to  build  a  bacithoe  simulator  based  on  a 
woricstatlon. 

Kim  and  Vanderploeg  (1986)  used  the  concept  of  velocity  transformations,  used  first  by 
letliovsity  (1978),  to  develop  an  efficient  0(Nh  method.' A  similar  method  was  also  used  by 
Huston  (1990).  Oarcfa  de  laldn  et  al.  (1989)  and  Avello  ei  al  (1993)  showed  the  potential  of  Kim 
and  Vanderploeg's  fonnulatlon  for  parallel  processing  on  shared  memory  worltstadons.  This 
paper  uses  the  main  Ideu  presented  in  Avello  et  aL  (1993),  with  slight  modincailons.  and 
presents  a  series  of  illustrative  examples  with  open  and  closed-loops.  The  efficiency  of  the 
formulation  is  tested  by  companng  the  CPU  times  of  this  formulation  with  the  fomiulation  used 
in  the  mulubody  program  COMPAMM. 

2.  Kinematic  Analysis 

in  this  section  we  present  efficient  recursive  solutions  for  the  position,  velocity  and  acceleration 
problems  of  multibody  systems  composed  of  an  arbitrary  number  of  joints  and  bodies.  In 
addition  to  a  global  (or  menial)  reference  frame,  consider  a  moving  reference  frame  ngidly 
anached  to  each  body.  The  position  of  the  mulubody  system  is  charactenzed  by  a  vector  x, 
composed  of 

•  Coordiruies  r  of  some  points  located  at  the  joints 

•  Components  u  of  unit  vectors  pointing  in  the  direction  of  the  joint  axes 

<  Coordinates  g  of  the  centers  of  gravity 

•  3x3  rotauon  matnces  A  relating  the  global  frame  with  the  moving  frame  of  each  body 
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Let  z  be  '*v.  vector  of  F  independent  joint  cooidinates  and  baae  body  variables,  where  f  is  the 
number  of  degrees  of  freedom.  For  the  sake  of  efficiency  we  will  assume  that  all  the  body 
reference  frames  are  initially  parallel.  If  they  are  not,  the  formulation  presented  in  this  section 
can  easily  be  generaiized  by  simply  applying  constant  rotation  matrices  to  the  ttansfoimaiions  of 
all  the  body  vectors. 

2.1.  KINEMATICS  OF  OPEN-CHAIN  MULTIBODY  SYSTEMS 

Consider  a  multlbody  system  with  tree  structure,  similar  to  the  one  presented  in  figure  I.  The 
mulubody  is  composnl  of  a  base  body  and  a  senes  of  branches  that  can  have  arbitrary  size  and 
disinbution  and  are  assumed  to  be  composed  of  rigid  bodies  interconnected  by  kinematic  joints. 

The  paths  going  fiom  the  base  body  to  the  distal  bodies  are  called  forward  paths.  A  cenaln 
body  can  be  reached  from  only  one  b^y  along  a  forward  path,  eacept  the  base  body.  One  or 
more  forward  paths  leave  from  each  body  eacept  from  the  distal  ones.  In  other  words,  all  the 
bodies  have  a  father,  eacept  the  base  body,  and  all  the  bodies  have  one  or  more  children  eacept 
the  distal  bodies. 

The  position  problem  consists  in  finding  the  deperideni  coordinates  a  given  the  independent 
coordinates  z.  This  can  be  done  in  a  recursive  manner,  stalling  fiom  the  base  body  and  moving 
forward  towards  the  distal  elements  in  the  different  branches. 

As  mentioned  earlier,  a  Is  composed  of  the  coordinates  of  some  pointsandvectcrs  located  at 
the  joints,  as  well  as  of  the  cooidinates  of  the  centers  of  gravity  and  the  loiaiion  matrices 
between  the  body  reference  frames  and  the  menial  frame. 

Figure  2  shows  a  genenc  body  y  that  has  an  input  pomt  located  at  the  joint  between  itself 
and  its  father  and  one  or  more  output  points  ,  ry, ,  etc.,  located  at  the  joints  between  itself  and 
Its  children. 

Figure  3  illustrates  a  genenc  joint  between  body  /  and  one  of  its  children,  body  AT.  The  body 
points  r^_  and  rt^ ,  corresponding  to  bodies  J  and  AT.  respecuvely,  are  located  at  the  joint 
between  the  two  bodies.  Similarly,  the  body  vectors  and  ut,  belong  to  J  and  AT, 
respectively,  and  point  in  the  direction  of  the  joim  axis.  Some  joinis,  for  example  the  sphencal 
joint,  do  not  have  an  axis  and  therefore  the  two  vectors  are  not  necessary.  For  the  moment  we 


at 


will  maintain  the  two  vectois  and  later  on  we  will  paniculanae  and  simplify  the  expressions  for 
the  different  types  of  joints. 

The  joint's  offset  is  given  by  d;t,  the  vector  from  to  rt,.  The  Joint's  rotadon  Is 
represented  by  the  3x3  rotadon  matrix  A^a.  Both  d,t  and  A,t  depend  on  the  joint  variables  a^t 
Assuming  that  the  position  of  body  7  and  the  joint  vanables  ate  Itnown.  we  can  compute  the 
rotadon  matrix  and  the  position  of  all  the  points  and  vectors  of  body  K.  The  expressions  to  obtain 
them  are 

ra|=r^+Ay(fy,-?^)+d;a 


Aa»AyA^a 
«a  =  ra,'hAa(ia,-r,j) 

'•a.=*a+Aa(Fa.-Ja)  (4) 

(5) 


where  the  upper  bar  denotes  coordinates  expressed  in  the  body  reference  frame.  Note  that 
equadons  (4)  and  (5)  also  apply  to  any  other  point  or  vector  of  body  J.  Equauons  (I)  through  (S) 
can  be  used  recursively,  following  forward  p^.  to  solve  the  posidon  problem. 

It  Is  possible,  and  even  convenient,  to  use  a  set  of  dependent  velocid'j  and  accelerauons  that 
does  not  correspond  to  the  denvadves  of  the  posidon  vector  x.  Wr  will  talte  as  dependent 
velKides  the  velocity  of  the  center  of  gravity  and  the  angular  velocity  of  each  body.  Consider 
again  the  generic  joint  of  figure  3.  Assuming  that  the  linear  and  angular  velocityofihebody/is 
known,  we  can  compute  the  velocity  of  A  as  follows 


(6) 

(7) 

gt  =  rt,+®ax(*t-rt,) 

(8) 
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Figure  4.  Opening  a  closed«ioop  system  by  cutting  joints 


(10) 

The  comsponding  expression]  for  scceleniions  are 

ft,  +<b^x(r^,-rJ+<oyXO)^x(r;.-r^)+d^t 

(12) 

(t  •  fii  +o*  x(g4  -ft,  )+»*  X  (ot  x(gj  -  rj, ) 
ft,  =  Jt +«it  x(rt.  -gtj+otxot  x(rt,  -gt) 
ut,  =<l)txut,+<0»x«txut, 

These  equauons  are  paiticulanzed  to  me  diReiem  joints  in  Appendix  A 

2  2.  KINEMATICS  OF  CLOSED-CHAIN  MULTIBODY  SYSTEMS 

Figure  4  shows  a  muiubody  system  with  several  ciosed  loops.  This  system  can  be  itansfonned 
into  one  (or  more)  open-tree  systems  by  “cutting”  some  of  the  joints.  The  effect  of  the  cut  joints 
IS  taken  into  accoura  in  the  foimuiation  by  introducing  tlie  expiicit  constraint  equattons 
corresponding  to  these  joints.  Therefore,  we  will  study  a  multibody  system  with  closed  loops  as 
an  open-loop  system  subjea  to  the  constraint  equations  of  the  cut  joints. 

Since  we  introduce  some  constraint  equauons,  only  a  subset  of  all  the  joint  coordinates  are 
independenn  Let  and  FV  be  the  number  of  degrees  of  freedom  of  the  open  and  closed  loop 
systems,  cespecuvely  (i  e  Fc  is  the  actual  number  of  degrees  of  freedom).  If  we  call  q  the  Fnxl 
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Figure  S.  Generic  join!  model. 

vector  of  open-loop  joint  vanablei,  only  a  subset  of  those  vanables  are  independent.  We  call  a 
the  FcxX  subset  of  q,  that  conuins  the  independent  joint  coordinates. 

To  solve  the  positioi:  problem  with  complete  generality,  let  us  consider  the  csubllshmeni  of 
the  constraints  corresponding  to  the  generic  joint  I,  located  between  bodies  J  and  K.  that  is 
shown  in  figure  5.  Each  body  has  one  point  and  one  unit  vector,  and  q^a  “iF  ihe  coonlinaies 
conesponding  to  the  joini  The  constraints  are 

4«'(ry.Uy.r».U*)-0 

Table  I  shows  the  constraint  equations  corresponding  to  the  most  common  joints. 


Joint 

Constraints 

Hinge 

r,-rj=0  u,-ua=0 

Sphencal 

rj-ra=0 

Universal 

r,-ra=0  u5'ua=0 

Cylindncal 

uj-ua  =  0  (rj-rt)xu,  =  0 

Prismatic 

u,-Ui=0  (ry-ra)xuy=0  UnUa,=0 

Table  1.  Constraint  equations  for  cut  joints 

These  equations  must  be  formulated  for  all  the  cut  joints  to  obtain  the  global  system  of 
nonlinear  equations 


<b(»(q))=0 


(17) 


The  vector  of  global  positions  x  can  be  computed  as  a  funcuon  of  q.  according  to  the 
expressions  printed  tn  section  2.!.  The  system  of  nonlinear  equations  ( 17)  can  be  solved  using 
the  Newion^Rai^n  method,  which  can' be  written  as 


(18) 


where  the  superscript  indicates  the  iteration  number.  Tht  iteration  process  must  continue  until 
the  ccns^iU'equations  are  satisfied  to  a  prescnbed  toterance.  Once  obtained  the  solution  q.  x 
can  easily  be  computed  from  the  expressions  derived  in  secuon  2. 1  for  open^loop  systems.  The 
denvation  of  the  expressions  for  the  Jacobian  is  illustrated  in  Appendix  B  through  an 
example. 

The  velocity  problem  can  be  solved  in  two  steps.  First,  calculate  the  dependent  Joint  velocities 
q  given  the  position  vector  x  and  the  independent  joim  velocities  z.  And  second,  calculate  the 
Cartesian  veloaties  of  all  the  points  and  unit  vectors  using  the  open*chain  muliibody  foimulauon 
explained  m  section  2.1.  For  the  first  step  we  need  to  differentiate  all  the  constraint  equations 
(17).  that  we  assume  holonomic  and  independent  of  time,  to  obtam 


(19) 


The  value  of  q  is  obuined  from  !he  soluuon  of  ihe  sysiem  of  linear  equations  (19)  for  the 
known  values  a.  The  velocity  of  the  remaining  points  and  vectors  can  be  calculated  rccuisively 
from  the  expressions  denved  in  section  2.1. 

The  acceleiaiion  analysis  can  be  performed  in  a  similar  way.  Differendating  expression  (19). 
we  obtain 


(20) 

Given  X.  X  and  the  acceleration  of  the  independent  joint  variables  a.  expression  (20) 
represents  a  system  of  linear  equations  that  can  be  solved  for  q.  Once  computed  q,  the 
accelerations  of  all  the  points  and  veciora  comes  from  equations  (I  l)-(I5). 


3.  Dynamic  Analysis 

The  viitual  power  forni  of  the  Newion-Euler  equations  of  motion  for  a  set  of  JVe  imerconnecied 
ngid  bodies  is 

Y'’'(MV+C-Q)=0 

where  M  is  the  6N^x6N^  mass  matnx,  C  is  the  6A^6Xl  vector  of  centn.\igal  forces.  Q  is  the  bN^xl 
vector  of  applied  external  forces.  Y  is  the  6N^\  vector  of  Cartesian  aculenuons  and  Y*is  the 
6NbX\  vector  of  virtual  Cartesian  velocities.  These  terms  can  be  wniten  as 


Ml 

[c,j 

[q.| 

1 

fVl 

M  = 

Ms, 

C  = 

tcar,! 

Q= 

1  :  1 

kJ 

Y  =  l 

The  6x6  mass  matnx  Mi  and  the  6xlveaor$  Cg.  Qg  and  Yg  corresponding  to  body  i  can  be 
expressed  as 
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(23) 


where  m,'  is  the  reus.  J;  the  3x3  inenia  lenur  expressed  in  the  menial  reference  frame.  1  the  3x3 
identity  matrix,  (Pfihe  angular  velocity,  g, 'the  posiuon  of  the  cemer  of  mass,  fj  the3xlvectorof 
external  forees  and  n;  the  3x1  vector  of  external  torques  applied  at  the  center  of  mass.  The  value 
of  J;  in  terms  of  the  constant  inenia  tensor  of  itie  body  3|  in  the  body  reference  frame,  is 
computed  ba 

Equation  (21)  is  the  yiitual  fomi  of  the  ^uations  of  motion.  In  Older  to  eliminate  the  vimial 
ydocitiu  from 'it,  the  CanesianyclociUes  V'must  be  expressed  in  temas  of  the  independent  joint 
vaiialiles  a.  This  transfoniiatioti  from  one  set  of  velocities  to  the  other  is  earned  out  in  the  next 
secdons  for  open  and  closed  loops. 

3. 1  DYNAMICS  OF  OPEN-LOOP  SYSTEMS 

Following  Kim  and  Vanderploeg  (1986)  and  assuming  that  the  constraints  are  Independent  of 
dm*,  we  can  write  a  linear  reladonship  between  the  independent  joint  velocities  q  and  the 
Cartesian  velocides  Y  of  the  form 


where  R  is  a  velocity  transformadon  matrix  of  size  iNixF.  Extraedng  the  6  rows  of  body  i  from 
expression  (23),  we  obuin 

Vi*RiR  (25) 

where  R(  is  a  6xF  matrix.  From  expression  (26)  we  deduce  that  the  ;-lh  column  of  R|  represenu 
the  body's  Cartesian  velocity  when  the  j-th  joint  variable  takes  unit  value  and  all  the  rest  are 
zero.  Therefore,  the  compuudon  of  R|  is  equivalent  to  compudng  different  sets  of  Cartesian 
velocides  of  the  l-th  body.  The  compuudon  of  Rf  is  presented  in  more  deull  in  Appendix  C. 
Differendadng  expression  (26)  we  obtain 

Y«Rq-hRq 

Extracting  from  equation  (27)  the  6  rows  corresponding  to  body  i,  we  can  wnie 

V.  =  R..q+(Rq)^  (28) 

which  allows  us  to  give  the  6x1  vector  (Rq)«a  physical  meaning.  It  represents  the  Carusian 
acceleration  vector  of  body  i  when  all  the  joint  accelerations  are  zero.  Therefore,  the 
computational  cost  of  calculating  (Rq),  is  equivalent  to  an  acceleration  analysis. 

Equation  (27)  and  the  vmual  fonn  of  equation  (25)  can  be  substituted  into  (21),  obuimng 

R’'MRq  =  R’"(Q-C)-R’'MRq 

which  is  the  final  fonn  of  the  equations  of  motion  forcpen^loop  systems. 
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3.2  DYNAMICS  OF  CLOSED-LOOP  SYSTEMS 

Similarly  to  what  was  done  m  Section  2.2.  a  sys^m  with  closed  loops  can  be  studied  as  a  tree- 
structure  system  subject  to  constraint.  To  eiiminate  the  closed  loops  one  must  "cut”  one  joint 
from  each  loop  and  then  impose  the  cut-joint  constraints  exjdicitly. 

.Let be  the  number  of  degrees  of  freedom  of  the  tree-structure  $y$iem;once  the  joints  have 
been  cut,  and  q  the  corresponding  F<^\  vector  of  joint  coordinates.  The  components  of  q  are  not 
independent  because  they  are  related  ihrou^  the.cut  joint  constraints.  Let  be  the  number  of 
the  degrees  of  freedprn  of  the  closed  loop  syst^  and  z  the  Fexl  vector  of  independent  joint 
coordiriatM.  A  linear  relatiortship  between  the  two  sets  of  joint  velocities  must  exist  and  can  be 
wnttenas 


q-R,i 


(3m 


where  R.  i$  a  mainx.  If  the  independent  cooidinaies  a  are  a  subset  of  q.  we  can  wnte 

i-Bq  (3,) 

where  B  is  a  FctF,  consiani  matnx  composed  of  zeros  and  ones. 

The  mairix  R.can  then  easily  be  computed  as  follows  by  appending  equation  (31)  to  (19), 
which  leads  to 


Isolating  q  we  rinaliy  obtain 


(32) 


(33) 


which  tells  us  that  R.  can  be  computed  as  the  last  Fe  columns  of  the  inverse  matrix. 
Differentiating  equation  (33)  we  find 


qwR,z+R|Z 


(34) 


Substituting  equation  (34)  into  the  equations  of  motion  (29)  and  premuliiplying  by  R,  we  obtain 


(35) 


K'’MRz  =  R’'(Q-C)-R''(MRq+RR,i) 
where  R  IS  the  Fc  matnx 

ff-RR,  (35) 

Expression  (36)  constitutes  the  set  of  Fc  second-order  differential  equations  of  motion  of  the 
closed-loop  system 

2.3  ALGORITHM  FOR  DYNAMIC  SIMULATION 

The  aim  of  this  section  is  to  present  a  general  algorithm  for  dynamic  analysis  of  open  and  closed- 
loop  systems  that  takes  into  account  several  efficiency  issues.  The  algonthm  is  as  follows. 


!.  Define  ihe  topology  of  the  mulubody  system  and  label  all  the  bodies,  joints,  points, 
vectors  and  joint  vanables 

2.  Select  Fe  independent  joint  vanables  and  assign  values  to  the  posmon  z  and  the  velocity 
z  at  time  ifO. 

3.  Calculate  and  solve  iteratively  equauon  (18)  for  q  and  (1)>(S)  for  x. 

4.  Solve  the  velocity  problem  through  equation  (19)  to  calculate  q  and  (6)*(10)  to  calculate 

i. 

5.  Compute  the  open-loop  velocuy*dependem  accelerations  Rq. 

6.  Solve  the  lin^  system  of  equations  (33)  to  obtain  the  matrix  Rx.  Calculate  RxZ . 

7.  DO'PAXAUMM.Ni, 

7.1  Calculate  the  teims  Mi,  C„  Qj  and  R; 

7.2  Calculate  R;  bymuluplymg  R,*Rs,. 

7.3  Multiply  Sf  M/.  S/" (Q,  -C.)  wd  If  (R.z). 

7.4  MdUply  (If  M,)(Rq)  and  If  (Mjl.). 

8.  Facioriae  MR  in  equation  (3S)  and  solve  for  z. 

9.  Integrate  (z.z),  to  obtain  (z.z),,^ 

10.  Set  r » It- dr  and  go  to  step  3. 

Tbe  DO  PARALLEL  statement  used  in  point  7  represents  the  system-dependent  directive  for 
parallelization.  This  directive  splits  the  iteration  loop  into  subiasks  and  sends  one  or  more 
subiasks  to  each  processor. 

The  most  aitraciive  feature  of  this  algonihm  is  that  there  is  a  signllicani  pomon  of  the  code 
that  is  subject  to  tun  in  parallel.  The  parallel  loop  contains  one  iteration  per  body,  which  allows 
for  the  body  by  body  compuutlon  of  the  final  vectors  and  matrices  of  equation  (35).  For 
moderate  size  problems,  the  typical  amount  of  code  (measured  in  terms  of  floating  point 
operations)  that  may  nin  in  parallel  is  between  SO  and  70%.  To  take  full  advantage  of  the  power 
of  parallel  compuulion  it  is  necessary  to  balance  the  amount  of  work  sent  to  each  processor.  The 
goal  IS  to  have  the  job  evenly  distnbuted  among  processors  and  to  avoid  having  some  Idle 
proccssois  while  ethers  are  overloaded. 

An  effleient  implcmenuuon  of  the  matrx  products  requires  that  the  sparaity  patiein  of  the 
matnees  be  considerecL  The  matners  usually  have  wide  ponions  of  zeros  that  can  be  exploited  to 
speed  up  Ihe  compulations.  Furthenriore,  the  mair,.  I’^  M  R  may  have  regions  of  zeros  that  can 
be  considered  by  using  a  skyline  profile  solver 

4.  Examples 

4.1  5-BAR  PENDULUM 

Figure  6  shows  a  S-bar  pendulum  with  5  revoluie  joints  and  5  degrees  of  freedom.  The  length  of 
all  the  links  is  L  =  I  m  and  they  have  a  unifonniy  distributed  mris  M I  Kg.  The  pendulum, 
initially  at  rest,  is  left  free  and  evolves  under  the  effea  of  gravity  g  =  9.81  m/s^.  The  equations  of 
mouon  were  integrated  for  10  s  using  Shampine  and  Cordon's  (197S)  DE  integrator  with  an 
error  tolerance  of  10'^  Figure  8  shows  the  z.  yand  z  cooidinates  of  the  point  P,  shown  in  figure 
6. 
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Hgure  6.  Spatial  5*b<x  pendulum 


Rgure?  Bricard  mechanism 


Rgure  8  Coordinates  of  point  P  of  the  5*bar  pendulum 

The  CPU  umes  for  this  example  obtained  with  the  mulubody  program  COMPAMM  and  the 
proposed  method  are  summanzed  in  table  2. 

4  2  BRICARD  MECHANISM 

The  single  degree  of  freedom  closed*loop  mKhantsmof  Hgure  7  is  called  Bricard  mechanism.  It 
IS  essentially  identical  tc  the  5*bar  pendulum  seen  in  the  previous  section,  except  that  the  last 
body  is  hinged  to  the  ground.  All  the  geometncal  and  inemal  properties  remain  unchanged  from 
the  previous  secoon.  The  mechanism  is  imtially  at  rest  It  is  left  free  and  evolves  under  the  effea 
of  gravity  g  =  9  81  m/s^.  The  equations  of  mouon  are  integrated  for  15  s  with  the  same  error 


Figure  Coordinates  of  point  of  the  Bncard  mechanism 


Figure  10.  Left  half  of  a  full  car  model. 

tolerance.  Figure  9  shows  the  a;,  r  coordinates  of  the  point  F  shown  m  figure  7.  A  companson 
between  the  CPU  times  obtained  with  the  program  COMPAMM  and  with  the  real'Ume  method 
are  shown  m  table  2. 

4.3  FULL  CAR  MODEL 

Figure  10  represents  the  left  half  of  a  car  model  that  ccmsisis  of  the  steenng  mechanism  and  the 
front  and  rear  suspensions  Vk  full  model  (comprising  the  nghi  half  not  shown)  consists  of  25 
ngid  bodies  and  has  IS  degrees  of  freedom.  6  of  them  corresponding  to  the  ngid  body  motion  of 
the  chassis.  4  to  the  up  and  down  mouon  of  each  suspension.  4  to  the  wheel  rotations  and  one  to 


the  rouUon  of  the  steering  wheel.  The  joint  types  are  indicated  in  ihe  figure  by  a  character.  R 
means  Rtvolute,  (/  means  Universal,  S  means  Sphtricol,  P  means  Prismatic  and  R&P  means 
Rack  and  Pinion,  TTie  numbenng  of  the  bodies  corresponding  to  the  nght  from  and  rear 
suspensions  Is  indicated  on  the  figure. 

The  car  model  conuins  several  closed  loops.  To  visualize  the  closed  loops  in  a  clear  way.  a 
schematic  grai^  is  shown  in  Figure  1 1 .  The  n^es  are  the  bodies  and  the  edges  are  the  joints.  To 
turn  the  car  model  Into  an  open^loop  mechamsm  it  is  necessary  to  remove  some  joints  or  bodies. 
The  edges  depicted  in  dashed  lines  correspond  to  the  cut  joints.  The  solid  lines  indicate  the  tree' 
structure  system.  Instead  of  removing  the  8  joints  coiresp^ing  to  the  bodies  5'.  9\  13*  and  17*. 
the  4  bodies  themselves  have  been  removed,  which  has  the  advantage  of  reducing  the  size  of  the 
opemloop  system.  The  mass  of  the  removed  bodies  has  been  transmuted  to  the  adjacent  bodies 
so  that  the  formulation  is  consistent 

The  contact  between  the  tire  and  the  ground  has  been  modeled  with  the  Calspan  tire  force 
model  (Bohn  and  Keenan.  1974) 

The  CPU  tunes  required  for  this  simulation  are  presented  in  table  2. 

4  4  CAR  CRASH  SIMULATION  WITH  HUMAN  BODY  MODEL 

Figure  12  represents  a  human  body  model  with  45  degrees  of  freedom.  The  degrees  of  freedom 
are  distnbuted  as  follows:  3  at  the  neck,  2  at  each  collar  bone.  3  at  each  shoulder.  2  at  each 
elbow.  2  at  each  wnst,  1  for  finger  motion  on  each  hand.  2  at  the  waist  3  at  each  hip.  1  at  each 
knee  and  3  at  each  foot.  In  addition,  there  are  6  degr^s  of  freedom  of  the  base  body,  which  is 
taken  to  be  the  hips.  The  3.  2  and  1  degrees  of  freedom  motions  at  the  joints  have  been 
represented  with  sphencai.  universal  and  revolute  joints,  respectively.  For  convenience,  the 


SI 


Figure  12.  Car  crvh  simulation  with  a45  degrees  of  freedom  model  of  the  driver 


model  used  for  compuuiion  used  only  revolute  joints.  Urdversal  joints  were  represented  as  two 
perpendicular  revoiute  joints  and  sphencal  joints  as  three  mutually  perpendicular  revolute  joints. 

The  driver  is  assumed  to  be  seated  in  a  natural  driving  position.  To  make  the  driver  maintain 
the  dnving  position,  torsional  springs  have  been  tnuoduced  at  the  joints.  Before  the  frontal 
collision  takes  place,  the  driver  is  traveling  at  a  constant  speed  of  5  m/s  (18  Km/h).  The  effect  of 
the  seat  belt  has  been  modeled  as  a  force  element  that  restrains  the  motion  of  the  chest  and  hips. 

Figure  1 3  shows  the  accelerauon  plot  of  the  dnver's  neck.  CPU  limes  are  shown  in  table  2. 


Examole 

COMPAMM 

Real'time 

Ratio 

5*baroendulum 

176 

1.1 

160 

Bncard  mechanism 

8  2 

1.1 

7.5 

Full  car  model 

203  5 

102 

200 

Car  crash  simulation 

7854 

14  2 

55  3 

Table  2.  CPU  times  per  function  evaluauon  measuml  m  mili.<«conds  on  a  single  processor  of 
a  SGI4D/240wori($iation. 
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Appendix  A 

This  appendix  pamculanzes  the  expressions  (1H15)  for  the  most  common  types  of  joints 

*  Hinge',  points  and  .  and  vectors  coincide  respectively  The  joint 

coordinate  is  an  angle  defined  on  the  unit  vector  . 


(A.1) 

(A.2) 

(A.3) 

(A.4) 

where  the  upper  tilde  denotes  the  3x3  skew*$ymmetnc  mainx  corresponding  to  a  cross 
product. 

Prismatic',  d^^  has  the  same  direcuon  as  vecton  and  .  and  ns  module  is  defined 
by  the  joint  coordinate 


(A.5) 

(A  6) 

+I,tO>XU„  XU,J 

(A  7) 

> 

II 

> 

(A.8) 

a,t  =  <^,k=0 

{A.9) 
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Cylindrical:  it  is  similar  to  the  revolute  joint,  but  with  an  additional  rotation  along  the 
axis  defined  by  the  vector  If  and  are  the  joint  coordinates  of  translauon  and 
roiauon  respectively ' 


(A.10) 

(All) 

XU/. 

(A.12) 

“/»=»>/. 

(A.13) 

<l/»  =i'»U/,  +2i;»<»/XU/.  +i5tia^xu;,  y.dHjXa,^) 

(A.  14) 

(A  15) 

Universal:  the  points  and  coincide  If  and  are  the  two  rotations  about  the 
two  axis  defined  by  the  vectors  and  Ujt,  respectively,  then 

(A  16) 

A*  =  A/)t(i}j.3y,)Aj4(i5,.Ut,) 

(A.17) 

Ui,  "Aju., 

(A.18) 

U.,  •((!), +lJtU,j)XUt, 

(A.19) 

(A.20) 

0>i  =®;  +i}tu„  +xjtu.,  +i)*u„  +xj.u., 

(A.21) 

Spherical:  the  points  and  coincide.  Using  Uie  Euler  Parameters  p 
(which  must  satisfy  the  constraint  eo^’Ci^+el'^el  si)  to  define  the 
rotations 

»(<0.ei.X2'«3) 
three  possible 

dysd^t»d^t=0 

(A.22) 

A*  =  A^A^*<z^i«p> 

(A  23) 

Ayz  (p)  =  (2eo  ~  *  2(ee^  +  e^e) 

(A  24) 

(iSji  s  2Gp 

(A, 25) 

1 


! 


f 
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Figure  14  Calculation  of  the  denvativesofa  loop  closure  condiuon. 


-<1  <0  -t}  <2 

G.  -<2  <3  '<0  -«1 

-<)  -<i  «1  '0, 

(A.26) 

iOjii  *2Gp 

(A.27) 

Flomng'ihtthnc  translations  are  defined  by  the  joint  coordinates  z]k,  zjk  and  Zyt.ihat 
coincide  with  the  coordinates  of  point  with  respect  to  a  reference  frame  (m.  n  ,  1) 
parallel  to  the  inertial  ones  with  its  ongin  in  the  point  .  The  three  rotations  arc 
introduced  in  a  way  similar  to  the  sphencal  joint 

d/fijtii+ijtn+ijtl 

(A,28) 

d;t  =  i|jin+i5tn+i5il 

(A.29) 

(A.30) 

Appendix  B 

71)0  jacobian  of  the  constraint  equauons  shown  in  table  I  can  be  calculated  as 


The  matrix  Ox  is  denved  in  a  straightforward  way  by  inspection  of  table  1 .  To  calculate  Oq,  it 
IS  necessary  to  evalua'e  the  denvatives  of  the  points  and  vectors  with  respect  to  the  joint 
coordinates  q.  This  m  eds  to  be  done  only  once  for  each  type  of  joint  since  the  results  may  be 
stored  m  a  joint  library  and  used  for  all  subsequent  jotius  of  tl»  same  type  Observe  that 

ilL 

which  means  that  the  terms  in  Oq  are  padal  veloaties  (see  Kane  and  Levinson.  i985)  that  may 
be  computed  by  calculating  the  velocity  corresponding  u>  an  input  zero  velocity  for  ail  the 
jo^.i  vanables  exapt  for  qt  a  1 

Let  us  illustrate  this  with  the  example  shown  in  figure  14.  The  figure  shows  a  cut  joint  / 
between  bodies  J  and  K.  There  is  a  hinge  joint  with  a  Joint  angle  r/  on  the  left  branch  and  a 
cylindrical  Joint  with  a  joint  angle  ^  oh  the  nghi  branch.  The  partial 

denvauves  menuoned  above  are  shown  in  table  3 


dr, 

iUi 

ir, 

it, 

uix[r,-r,) 

UiXUj 

0 

0 

0 

0 

UfflXUt 
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0 

0 

0 

Table  3.  Jacobian  ^q  for  the  example  of  figure  14 


Appendix  C 

In  this  Appendix  we  present  the  expressions  for  the  calculation  of  the  submainces  R,  of 
equation  (26).  Each  submatnx  R,-  is  of  size  6x/>  where  is  the  number  of  degrees  of  freedom 
of  the  open'loop  system.  Each  column  of  Rt  is  computed  by  giving  a  unit  velocity  to  each  joint 
vanable  and  by  computing  the  resulting  body's  velocity.  If  the  body  is  on  a  different  branch  than 
the  unit  joint  velocity,  the  corresponding  column  of  Rj  is  zero.  Likewise,  the  columns  of  R| 
corresponding  to  the  joint  vanables  located  further  along  a  forward  path  are  also  zero.  The  only 
nonzero  columns  of  R,  are  those  of  the  joint  vanables  preceding  the  body  on  the  same  forward 
path. 

We  now  present  the  values  of  Rj  for  the  joint  vanables  corresponding  to  the  most  common 
t>pe$  of  joints.  The  number  of  columns,  that  vanes  from  one  joint  to  the  other  depending  on  the 
number  of  degrees  of  freedom,  is  shown  on  the  lower  nght  part  of  the  matrix. 


•  Hinge  Defined  by  point  and  vector 


•  Fnsmanc:  Defined  by  vector  u, 


(Cl) 


(C2) 
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Efficient  Object-Oriented  Programming  of  Multibody  Dy¬ 
namics  Formalisms 
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Aistkact.  a  ci««  itructure  for  the  obj«ct*<X)eQted,  aumerteaJ  laagutge  C-f-f  it  ptewcted  to 
repi4e«  the  buduio  toAltr  type  dctUt  with  »  oew  m«!v  cIma  te  (tcAlM  envuonme&t)  Matrix* 
and  vcctor^cluaei  programrned  with  the  ute  of  the  tcaUr  elati  te  allow  comfortable  object>orieDted 
prosrammiog  aod  modifying  of  multibody  formaliaim.  Beeauae  an  inttance  of  a  it  ttoiea  further 
informatioa  beatdea  the  magnitude  of  a  acalar  number,  operationa  with  te'a  can  be  optimited  with 
reapect  to  muitibody  formaUama.  The  number  of  6oatuig  point  operationa  remaining  after  opti* 
ouaation  can  be  counted  and  an  executable  program  b  creat^,  which  executea  only  theae  minimum 
number  of  floating  pomt  operationa.  Thia  aervea  aa  a  baaia  for  comparing,  modifying  aod  optimising 
given  fbrmaUama  with  reapect  to  the  multibody  ayatem  under  inveatigation.  Aa  an  example,  an 
implementation  of  the  recuraive  formaliam  la  preaented  in  the  paper. 


1.  Introduction 

During  the  last  decades  a  large  number  of  multibody  dynamics  formalisms  for  different  pur* 
poses  have  been  published,  specially  the  development  of  the  recursive  formalism  (l),  [18], 
(7],  (4|  has  shown  the  need  for  comparing  the  efficiency  of  multibody  dynamics  formiiismt. 
This  hu  been  done  using  different  methods,  e  g.  counting  the  necessary  operations  by 
hand  [4|,  {15],  with  the  aid  of  a  symbolic  manipulation  program  (16),  or  by  measuring  the 
CPU'time  for  one  evaluation  of  the  rigbt<ha&d  side  (13).  For  a  seriiJ  chain  of  rigid  bodies 
connected  by  revolute  jdots,  Fig.  1  shows  the  basic  difference  between  an  implementation  of 
the  recunive  and  an  implementation  of  the  noarecursive  method  described  in  (12).  While 
the  CPU-time  of  the  recuruve  formalism  incieases  with  Order(n),  l.e.  linearly  with  the 
I  number  of  joints  n,  the  noorecursive  method  increases  with  Order(n’).  The  intersection 

;  point  is  at  about  five  joints.  Surprisingly,  this  doesn’t  hold  any  more  for  systems  with 

1  parallel  tree  structure,  i.e.  sytems  where  the  number  of  branches  is  close  to  the  number 

\  of  bodies,  since  the  nonrecursive  method  used  here  for  the  comparison  (12)  also  shows  an 

!  almost  linear  behaviour.  Thus,  for  many  practical  applications  an  optimized  nonrecursive 

I  method  15  faster  than  the  recursive  method. 

I 


scnal  upDlogy: 


ptnUel  lopology: 


Figure  1:  Compaiuoa  of  the  recur^ve  with  a  nonrecuriive  formaJism  [13] 


There  were  publiihed  »  number  of  vereiont  of  the  recurtive  formaJiBm  (7],  [4],  {2],  (17).  They 
use  differeat  coordiaate  lystems  ud  reference  poisU  to  evaluate  the  recursive  formalism. 
These  versions  of  the  recursive  formahsm  have  beea  compared  in  [15)  and  [16],  using  again 
a  serial  chain  of  ripd  bodies,  connected  by  rev<4ute  j^nts.  Fig.  2  shows  the  differences 
between  the  versions  of  the  recursive  formalism. 


Figure  2:  Comparison  of  variants  of  the  recursive  formalism  for  a  serial  chain 
with  revolute  joints  (15) 


Tbe  minimum  number  of  flojiting  point  operations  nre  based  on  very  specia)  optimizations, 
which  are  only  possible  for  the  benchmark  system  used.  i.e.  a  serial  chain  with  rigid  bodies 
connected  by  revolute  joints.  These  well-known  results  show  that  a  multibody  system 
program  can  be  made  more  efficient  by  ck^osing  an  adequate  formalism.  As  Fig  1  shows, 
the  efficiency  of  a  formalism  depends  stroni^y  on  the  system  it  Is  applied  to.  Unfortunately, 
there  are  only  a  few  comparisons  for  some  formalisms  on  only  some  benchmark  problems. 
To  hnd  an  optimal  formalism  for  a  ^ven  problem*  it  would  therefore  be  helpful  to  have  a 
better  comparison  of  formalisms  on  a  wider  variety  of  systems  and  to  have  an  environment 
to  program  and  modify  comfortably  formalisms  and  to  apply  them  to  a  particular  system. 

One  answer  of  computer  science  to  program  and  modify  quickly  and  savely  large  and 
complex  algorithms  like  multibody  dynamics  formalisms  is  to  use  object  oriented  program¬ 
ming  (OOP)  (3).  There  is  a  large  potential  to  do  this  In  multibody  dynamics  on  different 
levels: 

•  OOP  on  the  system  leve’:  description  of  the  given  system  with  objects  (bodies,  joints, 
coordinate  systems,  subsystems  etc.)* 

•  OOP  on  the  formalism  level:  defining  kinematic  and  kinetic  methods  for  the  objects 
introduced  on  the  system  level, 

•  OOP  on  the  linear  algebra  level:  matrix  and  vector  operations, 

•  OOP  on  the  scalar  level. 

Since  there  ve  already  objects  in  multibody  systems,  OOP  on  the  system  level  has  always 
been  done.  Recent  investigationi  consequently  use  object-oriented  models  for  the  database 
to  store  the  system  information  [11).  Using  OOP  on  the  formalism  level  is  more  difficult 
and  a  current  field  of  research  (9|,  (10].  OOP  on  the  linear  algebra  level  is  quite  common, 
there  are  already  commercial  padtages  available.  There  are  several  methods  to  do  OOP  on 
the  scalar  level: 

•  Using  the  built-in  scalar  types  like  douife  in  €+-1* .  This  ii  inefficient.  For  example, 
when  programming  the  recursive  formalism  using  vector  and  matrix  notation,  the 
numbers  of  Fig.  2  can  only  be  achieved  by  taking  care  of  zeros,  ones,  constants,  as 
well  as  unnecessary  and  equal  operations  and  so  on. 

•  Using  a  sy.mbolic  manipulator  for  scalar  antbmettc  and  an  OOP-language  for  the  rest. 
This  is  uncomfortable  to  program  because  of  the  two  programming  packages. 

•  Using  special  objects  to  do  scalar  arithmetic  optimized  for  multibody  formalisms. 
This  has  been  done  e.g.  by  Sayck  in  the  program  Autosim  [14|.  Since  Autosim  is 
encoded  in  the  numerically  leu  efficient  language  Lisp,  this  requires  again  another 
compiler  to  run  the  final  program. 

The  language  C-f'-i-  clums  to  be  an  effident  numerical  language  and  to  allow  object  ori¬ 
ented  programming  (6).  This  paper  describes  a  way  to  do  optimized  scalar  arithmetic 
in  C-f-P.  An  algonthm  programmed  with  newly  introduced  scalar  objects  will  be  au¬ 
tomatically  optimized  with  respect  to  a  multibody  dynamics  formalism  programmed  m 
vector  and  matrix  notation.  The  paper  describes  first  the  programming  concept.  Second, 
as  an  example,  an  implementation  of  the  recursive  formalism  In  the  form  suggested  by 
Brandi/Jobanni/Otter  (4j  IS  described. 
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2.  Object  oriented  environment  for  optimized  scalar  algebra  in  C++ 

The  scalar  types  float  or  <jou6/e  of  C+’f  ^on*t  take  care  of  special  information  which  would 
be  necessary  to  optimize  a  multibody  dynamia  formalism  programmed  in  matrix  and  vector 
notation.  Even  a  standard  optimizer  isn’t  capable  to  do  this  to  a  full  extend.  Important 
optimizaUon  information  of  scalars  are 

•  the  ori^n  of  a  number:  constant  from  file^  internal  constant,  internal  variable,  input 
variable  ^m  integrator,  Integration  variable, 

•  special  constants  like  zero  or  one, 

•  the  history  of  operations,  which  are  necessary  to  calculate  a  number. 

Therefore,  a  new  class  se  hu  been  developed,  which  completely  replaces  the  buildon  scalar 
type  double  of  An  instance  of  se  references  not  any  more  a  number  itself  but  instead 
all  information  to  optimize  operations  formulated  with  se’s.  All  standard  operators  have 
been  overloaded,  so  there  is  almost  no  ditfetence  between  programming  with  double*  and 
programming  with  se's.  One  advantage  of  using  overloaded  operators  is  that  there  is  no 
need  to  write  a  scanner  and  parser  as  in  a  symbolic  laa^age,  since  the  scanner  and  parts  of 
the  parser  from  C++  itself  is  used  (8).  The  basic  class  structure  is  taken  from  a  simplified 
model  of  a  macro-assembler  or  compiler  [8],  see  Tig.  3. 


■saw  Miiwhlw  da«NrMMr«ifr'^sieitem 


Figure  3:  Gass  structure  of  the  scalar  programming  environment 


The  result  of  running  a  program  formulated  with  the  scalar  objects  re  will  be  a  bst  of 
operations,  which  can  be  cairied  out  immediately  by  interpreting  it  or  with  full  speed  after 
another  compilation  step.  The  mam  advantage  of  the  list  of  operations  together  with  the 
special  information  stored  for  each  scalar  is  the  possibibty  to  perform  local  and  global 
optimizations. 
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•  Local  optimizations  result  immediately  from  one  operation  and  its  operands,  e.g 
0  ‘  X  *-*  0, 1  ■  X  or  I  •  6  ^  a, . . . 

•  Global  optinuzations  result  from  information  about  the  complete  bst  of  all  operations. 
At  the  moment 

.  elimination  of  equal  operations, 

-  elimination  of  dead  end  code, 

-  separation  of  operations  with  constant  mults,  and 
sepsxatlon  of  operations  only  used  for  report 


I 
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is  implemented. 

To  simulate  the  forward  dynamics  of  a  multibody  system,  an  Integrator-fanction  calls  very 
often  the  right  hand  side  of  the  equations  of  motion.  At  best,  the  whole  right  hand  side 
is  programmed  using  the  newly  introduced  scalu  class  $e.  Usually  less  often  than  the 
integration  variables,  report  variables  are  calculated  at  desired  timecteps.  The  scalar  class 
sc  distinguishes  between  an  Integrator  variable  and  a  report  variable.  All  operations  to 
calculate  only  report  variables  are  separated  and  carried  out  only  if  necessary.  There  has 
to  be  an  interface  between  the  part  of  the  program  written  in  convential  C/C-f-f ,  e.g.  the 
integrator,  and  the  algorithm,  which  Is  pn^ammed  using  the  scalar  class  ic.  This  is  done 
with  the  interface  variables  for  input,  output,  and  report  which  axe  se's  and  global  variables 
at  the  same  time  (see  Fig,  4). 


Figure  4:  Interface  of  scalar  environment  to  sorroundiog  program 
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After  the  list  of  operations  has  been  optimised,  the  operations  can  be  counted.  Thus,  the 
result  IS  the  minimum  number  of  floating  pcwt  operations  together  with  an  executable 
program  which  runs  with  this  minimum  number  of  operations. 


3.  Example 

The  previously  introduced  method  is  now  applied  to  a  benchmark  problem.  The  forward 
dynamics  of  a  serial  chain  of  n  ri|pd  bodies,  connected  by  revolute  joints,  is  solved  with  the 
recursive  method,  see  Fig.  5. 


Figure  S:  Benchmark  system 


The  recursive  method  can  be  derived  from  the  locally  formulated  equations  of  motion  (17). 
Sixdlmensional  notation  will  be  used,  where  the  3  x  l*veIocity  r  and  the  3  x  l.anguJar 
velocity  w  of  a  rigid  body  are  combined  In  the  6  x  1  velocity  v  »  Similarly 

a  3  X  i*force  v  and  a  3  x  l.moment  it  acting  on  a  body  are  combined  to  a  6  x  l.force 
/  s  With  the  symmetric,  poritive  definite  6x6  mass  matrix  M ,  the  Jacobian 

H,  the  joint  variables  0,  the  slxdlmenrional  joint  reaction  force  /  and  the  sixoimensionaJ 
force  g,  which  collects  the  external,  applied  forces  and  moments  and  the  gyroscopic  terms, 
the  equations  of  motion  are 

AfjVj  - /j  +  =  Sj  ,  ^sl,...,n 

Vj  -  jG'e,  -  Hj9j  =  7,  »  J  =  .  n 

Hjf,  =  o  ,  j  = 

The  index  ”y”denotet  sn  arbitrary  body  in  the  chain  with  a  possible  predecessor,  indexed 
with  ”r,  and  a  possible  successor,  indexed  with  The  matrix 


transforms  the  sixdimensional  velocity  of  body  "t”,  ,v„  with  respect  to  reference  point  0, 
to  the  same  velocity  of  body  but  with  respect  to  reference  point  G;,  where  ^he 

distance  from  0,  to  G,  is  d;,.  To  simplify  nomion.  the  left  lower  index  for  the  referenr* 
point  is  omitted,  if  identical  with  the  right  lower  index  for  the  body.  These  equations  of 
motion  can  be  solved  recursively  (4|,  {17),  see  Fig.  6. 
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•il 

•  Projection:  for  j  s  n,...,2  do 

I 

i 

M,  =  M,+,Cf'^(Mi-M,B)(BjMiair'BjMi)iff 

•i 

1 

9,  =  9i+,er^(I-MiB,(BfMiB,)-'Bf)(9i-Mni) 

•  Solving  for  root. 

}  1 

1  ( 

01  = 
oi  s 

'  1 
1 

•  Backsubstitution  for  j  s  2. .  ,  n  do 

1 

Si  =  (B]M,B,r'B]^9,-M,(jCfv,+yi)) 

1 

, 

Vj  s  Hyfiy +^Cr'»/+'jry 

Fi^r«  €:  Recursive  solution  of  equntions  of  motion  [17] 


A  very  efficient  computational  scheme  to  solve  the  equations  from  Fig.  6  is  given  in  [15], 
see  Fig.  7. 


«  Projeetioo:  for  jsn...2  4o 

V,  =  MiB,  ,  Di  =  (BjVi)-‘ 
f/  =  V/Di  ,  tcisBjti 

<  =  M,-r,vJ 

»f  =  AffT, 

M,  = 

Oi  = 

•  Solving  for  root  for  ;  s  1  do 

V.  =  M,H.  ;  Di=(Hrv,r' 
f,  =  V,C,  ,  w,  =  Sf9, 

»1  = 

«  Bscksuhstuutloo:  for  i  =  2  .  n  do 

Rj  =  )<?vt+7j 

h  =  0/v>/-rfn, 

V,  =  R,  +  H,*, 


Figure  7.  Computational  scheme  for  recursive  method  [16] 
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To  impiement  the  compuUtiooai  scheme  of  Fig.  7,  a  reference  point  and  a  coordinate  system 
have  to  be  specified.  This  example  follows  the  suggestion  of  Brandl/Johanni/Ottcr  [4]. 
The  local  coordinate  system  as  introduced  by  Denavit/Hartenberg  [5] 

is  used  to  express  all  magnitudes  of  body  The  Origin  0,  is  used  as  reference  point, 
see  Fig.  8. 


Figure  8:  Denavit>Hartenberg  coordinate  systems 


To  express  a  vector  or  matrix  in  coordinates  of  a  coordinate  system  they 

will  be  'tooted  with  upper  left  index,  eg.  ‘u  s  (*r^»  The  transformation  matrix 
*K,  for  sixdimensiooai  velodties  and  forces  between  coordinate  system  K{0)^X},y,,z,)  and 
K{OuX*%yuZ*)  consists  therefore  of  the  known  3x3  orthonormal  transformation  matrix 


The  most  cntical  part  with  respect  to  efficiency  of  the  formalism  is  to  transform  coordinate 
system  and  reference  point  of  the  mass  matrix  Mf  and  the  force  gf  from 
to  the  previous  body  A'fOi.XMp,,;,). 

:M,  =  \M,+ ,K’^]  ',a'  , 

Is.  =  . 

An  efficient  procedure  is  to  do  it  step  by  step  across  the  intermediate  reference  frame 
A'(C)|.,Xt«,y,.,x,.),  since  then  a  maximum  of  zero-  and  one-operations  aie  exploited.  It 
can  also  be  shown  that  it  is  more  efficient  to  first  transform  the  coordinates  and  then  the 
reference  points,  i  e. 
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Most  parts  of  the  formalism  can  be  programmed  directly  in  siX'dlmensional  vector-notation, 
because  the  previously  described  scalar  environment  will  take  care  of  zero-  and  one-opera¬ 
tions.  However,  for  the  previously  described  transformation  operations,  it  is  more  efficient 
to  decompose  the  six-dimensional  operations  into  three-dimensional  operations  and  write 
special,  optimized  methods  for  the  three-dimensional  coordinate  transform:  tions,  where 
the  different  reference  frames  are  just  rotated  about  one  coordinate  axes.  One  example  is 
the  coordinate  transformation  between  and  K{Ot,^x,„y„,z„)  for  a  3  x  3 

tensor  A. 

"A  =  "Tj  >A  ‘t/ 

cmB  -smd  0  \  /  oit  ois  ois  \  /  co«$  sin^  0  \ 

•in^  coed  0  ]  |  on  on  on  ]  I  -sin^  co»6  0  ] 

0  0  1  /  \  Oil  on  uss  /  \  0  0  1  / 

(093-^cos^/ii  on*fsui#hi  oncost  -  ajssm^ 

0)i+sio^A|  aii~<os^Ai  ojssin^ 'i' oncost 

d}]  cos^  -  033tin^  dsisiB^-S-Asicoi^  an 

With  Ai  =  (an-an)co8tf-(ai2-i-a3i)sind,  A)  s  cos^At,  As  “  sm^Ai,  the  transformation 
can  be  achieved  with  U-b  and  12«,  besides  2  trif^nometnc  function  evaluations.  For  a 
symmetric  matrix  A,  thia  reduces  to  8-h  and 

To  avoid  the  transformation  of  the  graviational  forces  from  coordinates  of  the  global 
reference  frame  into  coordinates  of  the  local  r^erence  frames  of  all  bodies  an  Important 
optimization  of  the  formalism  is  to  ffctively  accelerate  the  ffrst  body  instead  of  adding 
gravitational  forces  (4],  or,  a  little  more  efitcient,  to  ffctively  accelerate  the  second  body 
and  add  gravitational  force  to  the  first  one  |1S).  Of  course,  If  there  are  any  springs  or 
dampers  between  bodies,  this  will  be  useless.  Additional  minor  optimizations  can  be 
achieved  by  moving  the  global  reference  frame  to  K{Oi,Xi,yi,zi)  at  t  =  0  and  to  de¬ 
fine  /f(0n,2niyNi^n)  >n  ^  way  that  On  s  0(n_|)*  and  the  vector  from  On  to  the  center  of 
mass  of  body  n  becomes  Pn  ~  Combining  the  previously  described  optimizations 

with  the  self-optimizing  scalar  environment,  table  1  shows  the  minimum  number  of  oper¬ 
ations  (without  2  *  n  trlgonometnc  functions).  For  n  >  2,  the  expected  0(n)  behaviour 


n 

• 

T 

- 

£ 

1 

8 

1 

2 

1 

12 

2 

106 

2 

46 

22 

176 

3 

309 

8 

163 

84 

364 

4 

319 

14 

296 

146 

973 

5 

729 

20 

429 

208 

1386 

Table  1‘  Minimum  number  of  floating  point  operations 

of  the  recursive  formalism  can  be  found.  The  sunimum  number  of  operations  for  n  >  2  is 
41  In  •  669  which  is  faster  than  the  number  470n-420  reported  in  (4),  sbghtly  faster  than 
the  number  432n  -  688  in  [16],  and  faster  for  large  systems  than  the  number  428n  -  737 
from  (15). 
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4.  Conclusion 


The  last  years  a  large  number  of  mUtibody  dynanucs  formabsms  have  been  published  and 
some  attempts  ha^  been  made  to  compare  them  with  respect  to  efficiency.  These  compar* 
Isons  have  shown  that  t^re  is  some  potential  to  make  a  program  faster  by  choosing  the 
optimal  formalism.  The  comparisons  also  have  shown  that  the  maximum  efficiency  of  a  for* 
malism'  depends  on  the  multibody  system  It  is  applied  to.  However,  only  some  formalisms 
were  compared  on  some  benchmark  problems.  Fbrthennote,  the  compared  formalisms  have 
been  strongly  optimized  under  assumptions,  which  am  not  always  applicable  to  more  prac* 
tical  multibody  systems.  A  better  way  to  choose  an  efficient  mnltibody  dynamics  formalism 
would  be  to  apply  a  larger  number  of  formalisms  to  a  multibody  system,  compare  them  and 
select  the  optimal  one.  This  paper  describes  an  object*oriented  programming  environment 
in  €+4-,  which  allows  comfortable  programming  and  modffication  of  formalisms.  Thus, 
a  larger  number  of  formalisms  can  be  applied  to  a  given  system  in  reasonable  time.  To 
compare  formalisms,  they  are  automatically  optimized  and  the  floating  point  operations 
are  counted.  To  verify  a  particular  formalism,  an  executid>le  program  is  generated,  which 
runs  with  the  minimum  number  of  floating  pcnnt  operations. 
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ABSTRACT.  OitcUMd  u  tbia  p&pei  k  «  b««  metkod  ibr  ik«  gcner^Uoi  of  JacobuA  muncea  »kkk  u 
partmUrlx  daatgiod  for  sae  ii  objact-oneatad  modaiiiaga  of  aaltibody  dysanua  baaed  on  the  iraunuanoB- 
daman  approach.  Tha  method  atarta  from  a  daaoipuoa  of  maltibody  baematiea  aa  a  lenea  of  gtaeral 
mappiaia  Uiwaat  maaifblda.  from  which  (ha  overall  JacobUa  raaalu  via  (he  chau  rale  —  aa  a  aeqacace  of 
aa(ru  prodaoa.  For  (haaa  matncaa.  a  aa«  tparaa-ma(rU  achaaa  ia  aoifoatad.  Theu  “elemeBU*  are,  bendea 
leroaa,  (ha  wdi-hioiri  apadat  (raaaformadoa  madkaa  aad  the  local  JacebaaM  of  tha  mdividaal  traaamiaaioa 
alemana.  U  ia  ahoira  how  (ha  mam  apptoachaa  for  calciiatwa  of  JacoUaaa  ia  tobotica  caa  be  vMwed  aa 
pardcilar  docompomtioaa  aad  maKipUutba  achamaa  of  the  apaio^matticaa  diacaaaed  above.  Fatthemore. 
(we  aaw  a^amaa  are  darivoi  whkh  may  be  advaatagooea  for  dyaamica  cakaladoaa.  A  companaoa  of 
catpatadea  dm  for  (ho  Jaoobiaa-baaad  laaeradoa  of  dyaaadcal  eqoadoaa  aad  other  methoda  (compoatte 
body  method,  rocotmvc  ma(hoda)  la  earned  o«t  with  a  Of-'f-implemeatatioa  of  a  particoiat  object- 
oneated  medaUiag  of  maltibody  dyaaouca. 

1.  Introduction 

The  modelling  of  multibody  dyoamica  hai  levernl  npplicntioDt  in  induitrial  engineering, 
which  adltogether  aim  at  reducing  coata  in  development  and  production.  A  topic  of  particu¬ 
lar  interett  U  the  on-line  itmulation  of  the  kinematic  and  dynamic  behaviour  of  mechanical 
syitems:  by  meani  of  this,  the  designer  can  obt^  a  better  understanding  of  the  influence 
of  relevant  parameters  in  the  system,  as  well  aa  precise  quantitative  information  about  ef¬ 
fects  which  are  difficult  to  estimate  due  to  inherent  sonlinearities  of  the  system.  For  the 
simulation  of  a  mechanical  system,  first  the  underijdng  mathematical  equations  must  be 
stated,  a  task  which,  due  to  its  complexity,  can  be  carried  out  for  even  modestly  sized 
systems  only  with  the  help  of  computers  and  specialized  multibody  programs.  After  two 
decades  of  research  in  this  field,  the  issues  which  have  prevailed  all  torn  around  the  topic  of 
speed.  Currently,  three  different  facets  of  this  notion  play  a  fundamental  role  in  multibody 
dynamics:  (1)  speed  of  modelling,  by  virtue  of  which  the  design  process  can  be  better  in¬ 
corporated  into  the  very  short  cydes  of  the  modem  production  process,  (2)  run-rime  speed, 
which  allows  to  use  the  models  for  ammation,  as  hardwaro-in-the-loop  components  or  as 
black-boxes  in  complex  computation  schemes  as  e.g.  optimization  and  parameter  estima¬ 
tion,  aud  (3)  speed  of  broadening  and  re^design  programming  processes,  which  is  the  mam 
factor  in  appbeations  in  which  the  underlying  equations  constantly  have  to  be  extended 
and  methodologies  from  different  disciplines  have  to  be  combined  to  cope  with  the  given 
problems,  as  it  is  the  case  e.g  in  the  field  of  meehatromes.  In  the  beginnings  of  roultibody 
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research,  the  emphasis  was  put  mainly  on  the  first  of  these  aspects  (Andrews  and  Kesavan 
1975,  Chace  and  Smith  1971,  Orlandea  et  al.  1979,  Wittenburg  1977,  Sheth  and  Uicker  Jr. 
1972),  while  later  in  the  eighties  the  rising  complexity  of  applications  forced  the  researchers 
to  develop  more  effective  formalisms.  These  arose  first  in  the  field  of  robotics  (Featherstone 
1987,  Walker  and  Onn  1982)  and  carried  over  to  general>purpose  programs  (Brandi  et  ai. 
1986,  CSarcia  de  Jaldn  et  al.  1986).  The  third  issue  is  a  topic  of  growing  importance,  be* 
cause  of  the  increasing  necessity  to  amalgamate  methods  from  different  branches  of  science 
in  order  to  be  able  to  solve  modem  problems  ade<)U£tely.  However,  surpriBingiy  almost  no 
attention  was  pud  to  this  Issue  until  very  recently. 

The  present  object’onented  modelling  of  multibody  systems  arose  from  the  demand  for 
efficient,  “hand'taUored"  programs  which  are  suitable  for  a  robust  and  fast  simulation  of  the 
dynamics  of  complex  mechanical  systems,  u  for  example  vehicle  dynamics.  In  the  approach 
introduced  in  Kecskemithy  and  Hiller  1993,  the  multibody  system  is  regarded  as  a  coUec* 
tion  of  independent  ‘"intelligent^  objects  which  take  care  of  specific  tasks  autonomously. 
This  allows  to  design  probiem*ipecific  programs  basically  in  the  tame  way  as  preparing 
the  input  file  for  traditional  self>contajned  programs.  The  objects  are  executable  and  can 
thus  be  incorporated  very  easily  in  superposed  tasks,  a  property  which  makes  them  ideally 
suited  for  multidiidplinary  projects.  In  this  paper,  the  intuitive  approach  is  extended  to 
cover  also  efficient  implementation  techniques  for  Jacobian  generation  and  composition. 
The  structure-dependent  Information  is  described  by  a  special  form  of  sparse-matrix  mod* 
elling,  and  weU*known  methods  from  robotics  are  incorporated  into  the  general  procedure. 
Also,  some  new  computational  schemes  arc  derived  which  offer  new  possibilities  for  effi* 
cieney  optlmitation  in  applications  involving  dynamics.  The  rest  of  the  paper  is  organised 
u  follows:  In  Section  2,  the  basic  ideu  of  the  present  object*oriented  modelling  will  be 
presented.  Section  2  contains  the  particulu  modelUag  of  Jacobiass  mentioned  above,  and 
Sections  4  and  5  encompass  the  main  results  and  the  conclusion  of  the  present  investigation, 
respectively. 

2.  Basie  ideas  of  the  propotcd  object-oriented  multibody  modelling 

Object'Onented  programmiog  lends  itself  for  combining  efficient  solution  techniques  with 
intuitive  interfaces  because  of  its  ability  to  hide  complex  data  and  operation  schemes  behind 
plain  terms  (Booeh  1991),  just  about  the  same  way  cwefully  introduced  notions  help  to 
understand  —  and  implement  ~  complex  relationships  in  mathematics.  The  key  issue  in 
object'oriented  programming  is  not  the  implementation  part  which  is  feasible  under  any 
of  the  currvnt  programming  languages  — <  but  the  de$ign  of  an  appropriate  decomposition 
of  the  physical  system  into  physical  objects  whose  b^aviour  can  be  mapped  as  directly  as 
possible  to  corresponding  executable  programming  modules.  A  crucial  issue  in  the  design 
process  is  whether  the  objects  reflect  more  the  details  of  the  particular  implementation 
at  hand  than  the  inherent  physical  properties  of  the  system  being  modelled.  This  dis¬ 
tinguishing  mark  is  most  appropriately  characterized  by  the  notions  of  “data-driven"  and 
“responsibility'driven”  approaches. 

The  traditional  practice  in  program  design  is  the  data-driven  approach.  Here,  the  ob¬ 
jects  are  defined  as  encompassing  units  of  the  data  structures  needed  by  the  algorithms. 
This  can  facilitate  the  implementation  of  a  particular  methodology  substantially.  However, 
because  of  the  dependency  of  object  definition  on  its  implementation,  the  objects  are  not 


only  dependent  on  its  intrinsic  behnviour,  but  also  on  issues  sncb  as  programming  style, 
compiler  features,  etc.  and  thus  for  many,  people  the  advantages  of  object-oriented  program¬ 
ming  do  not  become  apparent.  In  contrast  to  this»  responsibility-driven  approaches  view  a 
pi^am  as  a  collection  of  either  active  or  pa^ve  entities  which  are  endowed  with  enough 
*‘intdligence”  to,carry  out  tasks  <—  their  so-called  ^nspomibUitie*^  —  rather  autonomously. 
A  partictriar  model  in  this  setting  is  the  ‘^cltent/aerver  moder  of  Wirfs- Brock  and  Wilker- 
son  1989:  the  tasks  in  a  running  program  reflect  here  typical  transactions  of  everyday  life, 
where  a  server. performs  actions  requested  by^a  client  according  to  a  specifle  contract,  the 
client’novhaving  to  be  informed  aboutimore  details  of  the  procedure  or  about  the  tools  or 
r^urcM  ui^  tberritt  .thM.n^ed  for  ipWng  ont  the  assignment.  The  advantage  of  this 
approacli  Is  t^t,  {^ter, carrying  out  the  modelling,  an  intuitive  programming  environment 
results  whi^  corresponds  In  a  high  degree  to  cont^ntional  graphic  user  interfaces  used  in 
CAD  environments  for  the  rapid  prototyping  of  mnltibody  systems.  Thus,  there  is  almost 
no  penalty  for  using  programming  tools  rather  then  graphic  user  interfaces,  but  a  high  gain 
in  modularity  and  further  applicability  to  further  tasks.  The  crux  of  this  approach  is  to  find 
a  particular  view  of  the  problem  which  indeed  facilitates  the  dissection  of  a  physical  system 
into  neatly  defined,  implementatioo-independent  ^'clients’*  and  '^servers".  TUi  section  gives 
a  short  overview  of  a  particular  method  of  achieving  this  representation  in  order  to  make 
the  subsequent  expositions  dearer.  The  interested  reader  is  refered  to  the  more  elaborate 
expositions  of  this  subject  In  Kecskemithy  1993  and  Keakem^thy  and  Hiller  1993. 

2.1,  OBJECTS  IK  MUITIBODY  SYSTEMS 


trantmiMioo  eiemenu  actuator  vanabies  reference  frames 


Figure  1:  Objects  in  multibody  systems 

The  key  idea  of  the  proposed  modelling  is  to  regard  the  multibody  system  as  a  collection  of 
kinetostatic  tmnsmisnon  elements  which  map  motion-,  force-  and  mass-related  information 
from  a  set  of  state  objects  to  another.  State  objects  are  able  to  bold  and  return  information 
about  position,  velocity,  acceleration  and  load  at  an  arbitrary  location.  Conceptually,  the 
multibody  system  is  obtained  by  attaching  or  ‘‘plugging  m”  specific  copies  of  state  objects 
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to  the  intend  outputs  of  the  transnutsion  elements  (Hg.  1). 

-The  state  objects  ^  subdivided  into  scalar  variables  and  spatial  objects.  The  ^‘spatial’' 
state  objMt  embraces  information  about  the  motion  of  a  reference  frame  K.  with  respect 
to  an  implidtly  deiined  reference  frame  as  wd!  as  about  the  load  being  appbed  to 
the  origin  of.X .  ;The  motion  information  is  comprised  by  the  orthogonal  rotation  matrix 
R‘  transformihg^vMtor  components  from  /C  to  /Cq  *  the  radius  vector  r  from  the  oripn 
of;iCe,  to  the.orii^  of  AC  i  the  angular  and  linear  velocity  and  v ,  respectively,  and 
the  cd^pbndihg  a^eration.t^s'w  and  «.  Besides  this,  also  the  force  f  and  the 
torque  r ‘.being  applied  to  the  frame  are  stMed.  IVee  vectors  v,  o  and  r  are  assumed 
to  be  measured  at, the  ori^  of  AC ,  and  aU  vectors  to  be  decomposed  in  AC .  For  notational 
convenience,  angular  and  linear  components  of  ^idty  and  load  ate  collected  in  twist  and 
wrench  vectors  (Hunt  1990)  1  =  and  w  a  ,  respectively. 

Scalar  state  variables  0  serve  as  actuator  inputs  for  joints  or  as  outputs  for  sensors 
performing  scalar  measurements.  They  also  integrate  Information  about  position,  velocity 
and  acceleration  as  well  as  a  load  component  describing  the  generalized  force  related  to 
the  variable.  The  sign  of  the  latter  is  defined  such  that  under  a  virtual  displacement 
a  positive  load  Qo  supplies  energy  to  the  system.  By  abuse  of  notation,  we  will  refer 
to  both  the  V4lue  of  the  variable  and  to  the  complete  set  of  its  Icinetostatical  information 
(i.  e.  position,  velocity,  acceleration  and  force)  irith  the  same  symbol  $ .  However,  under 
computational  aspects  it  is  wise  to  explicitly  diiMm  linear  and  angular  variables  whose 
values  Ue  on  the  resl  line  R  and  the  circle  ,  respectively.  This  dlfTerentiatlon  is  observed 
in  some  cases  below. 

A  buic  Idnctostatic  transmission  is  capable  of  carrying  out  motton  frsnsmuston  and 
force  fransmtsston  (Fig.  2). 


Figure  2:  A  simple  transmission  element 


Position 

Velocity 

Acceleration 

Force 


The  operation  of  morion  frartimtsiton  consists  of  the  three  sub-operations 


position;  ^ 
velocity; 
acctltr.tion:  j' 


^S) 
J.i; 


.■  7  it 


(1) 


where  £  €  R"  ,  €  R'"  ,  and  €  R"****^  is  the  Jacobian  of  the  transnussion  element. 

Under  the  assumption  of  an  tdtal  transmission  element,  i.e.  one  that  neither  generates 
nor  consumes  power,  a  force-transmission  mapping  can  be  defined  from  the  equality  of 
virtual  work  at  the  input  and  output  of  the  transmission  element, 

=  . 
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After  subsUtiting  s  6^  and  notiog  tbu  this  condition  must  hold  for  all  €  R"  « 
one  obtains  the  force  tmn$mi$nm  function 

isxssi  2  =  Jjg;  .  (2) 

Note  that  this  force  mapping  is  directed  in  oppoiite  dire<‘tion  to  the  motion  transmission. 
This  property  is  quite  general  and  can  be  verified  in  many  appU  'ions  (e.  g.  Luh  and  Zheng 
1985). 

2.2.  geometric  modelling  of  fRANSMISSION  ELEMENTS 

A  general  transmission  element  can  be  mod^kd  mathematically  u  a  mapping  from  a 
general  '‘input"  manifold  X  to  an  “output"  manifold  X*  (Fig.  3). 


Figure  3:  Mappings  betv*<,  tn^  avifoldi 

The  model  of  a  manifold  is  used  here  berause  it  a  m«ans  of  considering  combina* 
tioDS  of  spatial  and  scalar  state  object*  a  single  g^c»reHc  entities 

X«a:x..-.xA:x.Rx...xRx5'x.<-x5*  ,  (3) 


where  nc  >s  the  number  of  reference  frames,  run  nr.  rud  n^*  are  the  number  of  linear  and 
rotational  vanablei,  respectively.  Given  i  mapping  X  -►  X\  x  €  X  *-*  r'  =  v'(  * )  € 
X‘  t  the  differential  map  or  push  forvard  function  tangent  vectors  v,  in  the 

tangent  space  T,  onto  tangent  vectors  >u  the  tangent  space  V,. .  This  mapping  is 
formally  defined  by  (Choquet'Bnihat  and  DcWitt-Morette  1989) 

dC(()  ,  ...  d(v>(C(())) 

^•'^'““dt  -  »  (4) 

where  C(0  is  a  general  trajectory  on  X  and  CTO  m  Hs  image  under  ^ . 

In  differential  geometry,  an  additional  geometric  object  is  deffned  which  is  the  linear 
mapping  of  tangent  vectors  to  the  set  of  real  numbers.  Such  objects  a' ,  denominated 
cotangent  vectors^  span  a  cotangent  vector  :oace  of  tame  dimension  as  Tt .  Associated 
with  9,  there  exists  a  function  tp*  which  maps  vectors  a‘  ..t  the  output  of  9  to 

corresponiUng  vectors  a  at  its  input.  This  mapping,  denominated  tne  pulPOack  function, 
is  defined  by 

9':  ,  a'-*a  =  9*(a')  :  a^v,)sa'(<.)  .  (5) 


! 
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By.  regarding  the  operation  of  computation  of  virtual  power  as  a  linear  mapping  of  tangent 
vectors  to  real  numbers,  it  is  easy  to  verify  that  cotangent  vectors  correspond  to  forces  and 
that  the  pull-back  function  models  the  force  transmission  (Kecskemethy  1993). 

2.3.  CONCATENATION  OF  TRANSMISSION  ELEMENTS 

By  the  manifold  ualogy,  chains  of  interconnected  transmission  elements  can  be  modelled 
as  composite  functions.  From  this  modelling,  the  laws  for  Jacobian  generation  simply  result 
as  a  consequence  of  applying  the  chain  rule.  For  example,  for  the  sequence  of  two  mappings 
/  and  g  in  Fig.  4  the  following  relationships  are  obtained  (von  Westenhob  1981): 


Figure  4:  Composition  of  mappings 


position;  <fi  s  go/  (forwards)  I 

tangent  vectors;  s  (9«/)*  ~  (forwards)  ?>  (6) 

cotangent  vecton;  v*  »  (9«/)*  *= (backwards)  I 

Note  that,  in  general,  the  operators  in  Eq.  (6)  are  applied  from  nght  to  left,  as  in  (p  o  f)(x)  s 
p(/(x)).  However,  it  is  common  practice  In  kinematics  to  view  sequences  of  transmission 
elements  u  in  Fig.  4  as  concatenations  starting  at  the  inertial  frame  and  moving  from  left 
to  right  as  one  proceeds  to  the  tipi  of  the  chains.  Thus,  in  the  functional  notation  the 
ordering  of  transmission  elements  is  reverie  to  the  ordering  of  the  ‘‘kinematical’'  notation. 
Also,  it  is  interesting  to  note  that  for  the  force  transmission  the  elements  are  again  traversed 
In  the  reverse  order  to  the  motion  transiniiiioo  sequence. 

A  general  composite  transmission  element  is  modelled  as  a  chain  of  simpler  transmis* 
Sion  elements  which  can  be  elementary  as  e.g.  links,  joints  etc.,  but  also  more  elaborate 
subsystems  such  as  closed  loops,  wheel  suspensions  or  complete  control  mechanisms.  This 
has  no  effect  on  the  definition  of  the  basic  mappings,  which  are  just  a  concatenation  of 
the  corresponding  mappings  of  the  components.  However,  for  computational  efficiency  it  is 
necessary  that  the  irnicriine  of  the  interconnection  structure  is  also  taken  into  account  in 
order  to  avoid  redundant  operations  in  the  calculation  of  products  such  as  in  Eq.  (6).  This 
IS  accomplished  by  the  method  discussed  in  the  sequel. 

3.  Modelling  of  Jacobinns 

The  concept  of  the  transnussion  element  introduced  In  the  previous  section  gives  a  means  of 
unifying  the  different  approaches  for  Jacobian  evaluation  used  in  multibody  dynamics.  In 
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this  setting,  Jacobi&ns  &re  regarded  as  the  differentiai  maps  of  the  underlying  transmission 
functions,  i.  e.  functions  transporting  tangent  vectors  at  the  input  to  tangent  vectors  at  the 
output  of  the  transmission  elements.  The  basic  idea  of  the  approach  is  that,  given  a  chain 
of  transmission  elements  as  shown  in  Fig.  5,  and  defined  by  the  composite  function 

vS  =  O  OV>i  V»l(*)  )'  (7) 

the  corresponding  differential  mapping  is  obtained,  according  to  the  chain  rule,  as 

*  Vfi.  *  ®  Vi»  »  (®) 

where  the  <fii,  are  the  differential  maps  of  the  individual  transmission  elements. 


Figure  5:  Concatenation  of  transmission  elements 


For  simpUficatioo  of  the  concatenation  operation,  it  is  advantageous  to  merge  all  input 
and  output  manifolds  of  the  individual  transmisaiott  elements  into  one  global  manifold  and 
to  regard  the  individual  transmission  elements  as  mappings  within  this  space.  Then,  the 
tangent  spaces  of  the  inputs  and  outputs  of  the  transmission  elements  are  all  identical,  and 
the  overall  Jacobian  results  from  a  compositloa  of  seveial  linear  maps  ,  where 

is  the  dimension  of  the  resulting  global  manifold  (Fig.  5).  In  the  following,  a  method 
for  the  efhdeot  computation  of  this  kind  of  composition  is  discussed. 

3.1.  LOCAL  STRUCTURE  OF  JACOBIANS 

For  the  analysis  of  the  structure  of  Jacobians,  consider  a  typical  mechanical  part  of  a  general 
multibody  system  here  denominated  a  '*m«ehanical  component"  C,  ~  consisting  of  a 
series  of  movable  rigid  or  deformable  bodies  mounted  on  a  floating  bare  (Fig.  6).  This  object 
has  as  inputs  the  motion  of  the  reference  frame  Kt  of  the  floating  base,  as  well  as  a  set 
of  /c,  internal  variables  representing  the  (independent)  generalized  coordinates  (e.  g. 
joint  variables  or  modal  coordinates  for  elastic  deformation).  The  outputs  are  conformed 
by  frames  attached  at  places  of  interest  or  further  couplings  to  the  moving  bodies. 

Regarding  this  object  at  a  gener^  mapping,  the  differential  mapping  transports  two 
^types"  of  tangent  vectors:  those  related  to  rigid'body  motion  i.e.  the  ai  d 

those  related  to  the  generalized  coordinates  i.e.  n>tuples  in  a  linear  subtpace  Vg  C 
R7^‘  .  Because  of  the  lineanty  of  differential  maps,  these  two  contributions  can  be  treated 
separately  and  added  together  subsequectiaUy. 

First,  consider  the  tangent  vectors  related  to  ngid'body  motion.  For  these  quantities, 
four  specificatioDS  are  necessary: 

(1)  the  reference  frame  Kj  whose  motion  is  measured, 


I 

i 
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Figur«  6:  Model  of  a  mech^nioLl  component 

(2)  the  reference  frame  Ki  with  reipect  to  which  motion  it  mewured, 

(3)  the  reference  frame  Kt  (fixed  with  reepect  to  Kf )'  whoie  origin  Ot  is  taken  as 
reference  point  for  the  Uneai  velocity  of  Kf  *  and 

(4)  the  reference  frame  Kk  In  which  the  vectors  are  decomposed. 

These  four  in^ees  are  arranged  in  the  general  case  ns  However,  for  most  applications, 

the  number  of  indices  can  be  reduced,  because  (a)  the  reference  frame  Ki  is  mostly  the 
inertial  frame,  and  (b)  the  reference  point  for  the  v^dty  U  frequently  identical  to  the  oripn 
of  the  reference  frame  whose  motion  is  measured.  Thus,  a  reduced  notation  involving  o^y 
the  indices  j  and  k  u  introduced  above  is  used  in  the  sequel. 

The  transmission  of  twists  involves  a  linear  transformation  of  the  twist  \  at  the  input 
of  the  mechanical  component  to  a  twut  at  its  output.  Here,  equal  indices  for  the  frame 
of  decomposition  and  the  current  moving  frame  are  introduced  for  further  simplification  of 
notation.  This  general  transformation  can  be  written  compactly  as 

(9) 

where  ^X,  is  the  tnruformaHon  morru” 


Here, '  U  ths  3  x  3  othogonal  rotation  matrix  transforming  vector  components  from  AC, 
to  I  is  the  radius  vector  from  origin  CA,  to  origin  Oj  decomposed  in  frame  Kk  (in 
this  parti^ar  case  with  k  -  j)  and  the  tilde  is  the  well-known  operator  for  constructing 
a  skew-symmetric  matrix  out  of  a  vector  such  that  r  x  s  r  x  x . 


Concatenation  of  spa^tial  transformation!  it  achieved  by  muitipbcntion  of  their  respective 
matrix  representations,  viz. 


(11) 


where 


•Rj  =  ,  (12) 

fr.  =  ■  (13) 

Also,  it  it  possible  to  decompose  the  general  spatial  transformation  matrix  in  a  part  ^Xf 
involving  pure  translation  (representing  the  change  of  reference  point  for  the  velocity)  and 
a  part  ^Xf  invol  'ing  pure  rotation  (representing  the  change  of  coordinates) 


(14) 


Note  that  here  the  radius  vector  iZf  utd  thus  ^Xf  Itself  it  decomposed  m  Kj .  However, 
the  effect  of  a  pure  translation  can  also  be  related  to  any  other  frame  Kt  by  meant  of 


‘«)xr=%''<xf  %*■' .  (15) 

In  this  notation,  t  marks  the  moving  frame  regarded,  i  the  frame  of  decomposition,  and 
)  the  origin  taken  as  the  reference  point  for  the  velocity  of  Ki .  For  example,  changing 
the  reference  point  from  the  origin  Ot  to  the  ori^  Of  within  the  same  rigid  body,  while 
mantaining  the  frame  of  decomposition  as  ^ ,  is  achieved  via  the  transformation 

(16) 


Next,  the  transmission  of  the  time-derivatives  of  the  generalized  coordinates  to  the 
twist  of  an  arbitrary  output  frame  Kj ,  decomposed  in  a  frame  ,  is  considered.  The 
corresponding  linear  mapping  is  denoted  as 


%  = 


(17) 


where  represents  the  focal  Jacohtan  of  the  transmission  element.  Here,  the  indices 
have  the  following  meaning:  t  records  which  set  of  generalized  coordinates  is  being  used, 
;  the  frame  whose  motion  is  measured,  and  k  the  frame  A  used  for  decomposition. 
For  elementary  transmission  elements,  the  Jacobiant  are  usually  given  o  pron.  In  this 
case,  the  frame  of  decomposition  is  identical  to  the  output  frame,  and  the  Jacobian  has 
mostly  constant  coefficients.  For  example,  a  revolute  joint  turning  Kt  to  K^  about  r,  s 
(regarded  as  component  C. )  has  a  local  Jacobian  of  =  (0,0,  l,0,0,0p  ,  while  a 
similar  prismatic  joint  generates  the  local  Jacobian  s  (0,0, 0,0,0,  Ip.  For  composite 
transmission  elements,  the  initially  given  local  Jacobians  are  gradually  ‘‘moved”  up  or  down 
the  branches  of  the  transmittion  elements  to  calculate  the  effects  of  th»  variation  of  local 
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geacralized  coordinates  in  other  places  of  the  molttbody  system.  Specihcally,  changing  both 
origin  and  frame  of  decomposition  from  Kf  to  Kk  is  achieved  with  the  transformation 

‘  .  (18) 

Chanpng  only  the  frame  of  decomposition  from  Kf  to  .  or  changing  only  the  point  of 
reference  from  Oj  to  Ot ,  result,  respectively,  in 

*Ji‘'  =  ‘XfOf  ,  (19) 

.  (20) 

In  thli  lut  equation,  the  general  notation  tndudea,  besides  the  indices  t,;,!: 

described  above,  an  additional  index  i  charactering  the  oripc  Ot  used  as  point  of 
reference  for  the  velocity  of  JC/ . 

Combination  of  twist  and  generalized  coordinate  transmission  yields  the  overall  local 
Jacobian.  For  example,  from  equations  (9)  and  (18)  the  resulting  local  Jacobian  for  the 
output  frame  Kf  in  Fig.  6  is 

'1/ =1'’'- 1  [  |;J  ■  (2» 

3.2.  CONCATENATION  OF  JACOBIANS 

Local  Jacobiani  in  kincmatlcal  subsystems  consisting  of  many  closed  loops  are  most  ef> 
fidently  evaluated  by  applying  hand'taUored  formulas  (Hiller  and  Keakemftby  1989)  or 
automated  symbolical  manipulation  schemes  (Keakemdtby  and  Hiller  1992).  However,  for 
series'connectioos  of  mecltaalcal  components,  an  automated  approach  can  be  stated  which 
leads  to  a  near'ininimum  computational  effort.  This  is  discussed  in  the  sequel  for  a  sequence 
of  serially  connected  transmission  elements  as  in  Fig.  7.  The  generalization  to  general  tree, 
type  structures  of  connected  mechanical  components  is  straight>forward  and  shall  not  be 
regarded  here. 

Assuming  that  the  mechanical  components  C,  in  the  sequence  are  already  modelled, 
the  local  mappings  :  ( /C, ,  as  well  as  the  correspondig  local  differential 

mappings  expected  to  be  known.  These  local  diferential 

mappings  are  now  embedded  in  the  global  tangent  space  as  discussed  above.  In  this  global 


- rr— - - - - - e - r - - 

spac^, « tangent  vector  has  the  structure  u  =  . 

differential  mapping  the  function 

9. :  V  H-  u'  =  V. «  (22) 


implier  a  sporse  “globalized'*  Jacobian  consisting  mostly  of  zeroes  and  ones  For 
example,  the  globalized  Jacobian  for  the  mapping  9,  in  Fig.  7  has  the  structure* 


<c.  .  K,  K,  K.  .K.,,  .. 

Fa  I  1 


"  f,:‘i  “®‘’‘/‘'’'‘  ““*  "*““•  «=“'  ®f  <l«»<iiMic  submutriee.  of  order  6  re^ 

the  *e»«4liM<l  coordinwee  of  the  eomponeati,  the  rabmtliicet  I,,  being  idesUty  m»tn. 
w  of  dimenuon  /«, .  tt  it  intereiting  to  reilite  tbu  the  itmcture'  of  thii  mnuix^inirrori 
ir  ‘r*  “i"  »  <1>«  «•««•!  trnnimJiiioa  element:  (1)  mnw 

^egonil  (la  thie  exemple  K,  ud  (2)  ontpnt  tnnaUu,  diitiagaiihed  by  non-zero 
«tnet  nntmg  u  the  coneepondin*  taa  (in  tbit  example  K, ),  and  (3)  throneh  eorwhfct 

^  ^  r°  *^“*11“  I*'*"*  *“  “"“Potiiin*  n>«  and  colnaia. 

p  the  Jrabian  of  a  compotite  tyttem  U  eatily  ettablUbed  by  maJti- 

plication.  For  example,  with  the  globalized  Jacobian  of  the  mappmg  v><  in  Fig.  7, 


the  Jacobian  of  the  compotite  function  ?  =  vo)eV<.,  is  obtained  at  the  product  ?.  = 
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V>i 


Figure  7:  Conc&ten&tion  of  mediimc&l  compouentt 


vo). ‘"<’(0.  •  y'****^* 


ATi 


K,K,  ..  x:.., 


C. 


‘X,  =  %>Xi  , 
•j‘;>  = 


(25) 


(26) 

(27) 


one  obt^i  agtin  n  globnlized  Jncobinn  of  the  Mme  etructure  u  those  in  equations  (23)  and 
(24).  Note  that  in  this  denvation  both  the  point  of  reference  and  the  &ame  of  deccs)pr«it>on 
are  taken  from  the  output  frame.  Alternatively,  one  may  relate  both  the  point  of  reference 
and  the  decomposition  frame  to  the  inertial  frame,  which  is  here  assumed  to  be  K\ .  Then 
new  representations  of  the  are  obtained  via  the  transformations 

V’O).  =  .  (28) 


where 


B  =  diag{/.,  ,  ‘X..,,  ,  /*.  } 


(29) 

Another  approach  is  to  use  as  reference  point  for  velocities  the  origin  of  the  corresponding 
output  frame,  but  as  decomposition  frame  again  the  inertial  frame  Such  a  representation 
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I 


>s  obt^ed  &niJogoa«Iy  to  Eq.  (28)  by  labitUttUag  in  £q.  (29)  the  tenni  by  . 
SifflU^rly,  the  sepretentfttion  ntiiig  the  ori^  of  the  inertial  frame  u  refereoce  point  for  the 
velodtiei  and  the  output  frame  ai  frame  of  decomposition  is  obtained  by  substituting  in 
Eq.  (29)  for  ^Xj .  The  relevance  of  these  different  schemes  will  become  evident 

m  Section  4.  For  the  moment,  it  Is  of  interest  to  iqipredate  how  different  methods  of 
applying  spatial  transformations  eventually  lead  to  completely  different  schemes  of  Jacobian 
evaluation. 

3.3.  SPARSE  MATRIX  HOOELUNO  OF  JACOBIANS 

In  order  to  take  advantage  of  the  sparse  structure  of  the  globalized  Jacobians  in  operations 
such  as  the  multiplication  discuss^  above,  a  particular  scheme  derived  from  w^.known 
sparse>matrix  techniques  is  introduced.  To  this  end,  the  general  differential  mapping  is 
decomposed  into  two  parts: 


<fi,  a 


(30) 


The  first  part  corresponds  to  the  diagonal  of 

=  diag|d«ti(^i)  /( , //f^ ,  •>;. ,  //(,  J  , 
where  o«ti  is  a  BooLEan  variable  characterizing  output  vanables, 


<r,M) 


f  I  if  ithr 
'  I  0  otherwi 


reference  frame  is  an  output 
otherwise 


(31) 

(32) 


and  is  an  identity  matrix  of  same  (Umension  as  the  number  of  internal  coordinates  of 
component  Ct .  The  remaining  matrix  now  has  very  few  elements,  which  can  be  stored 
using  a  modif.cation  of  the  weil«kaown  sparse  row^wise  format  (Pissanetzky  1984).  This 
scheme  is  as  follows: 


(1)  In  a  field  elynte.  store  pointers  to  the  aoo*vanishing  entries  of  matrix  (local 

Jacobians '  and  spatial  transformations^X«)  row  by  row.  The  order  of  the  elements 

within  a  row  is  immatena),  but  rows  must  be  stored  in  order  of  their  appearence  from 
top  to  bottom. 

(2)  A  field  contains  the  columns  where  the  entries  of  el— enti  are  placed  in 

V. . 


(3)  A  farther  field  rows  holds  the  row  indices  of  where  non*zero  elements  occur. 

(4)  Fmally,  the  places  in  el— 1>  and  where  new  rows  (of  p,  )  start  are 

recorded  in  a  field  rot^polnters. 

For  example,  the  sparso'matnx  storage  ucheme  for  the  Jacobian  resuling  from  £q.  (25) 
would  look  like 


rows 

rot’-polnters 


I'x, ,  'j</> ,  *x, ,  ‘jf* , 

(i,n  +  i+  I,i,n  +  i+l,n  +  t  +  2] 
(1.3) 


S3 


Thus,  it  takes  only  a  few  additional  entries  (14  elements,  in  this  example),  to  store  the 
stractare  of  the  Jacobian.  It  should  be  noted  that  this  information  is  bauc^y  equivalent 
to  sraph*theomtie  methods  such  as  the  a^acency  matrix  approach  (Wittenburg  1977). 
The  ^vutage  of  this  representation  is  that  it  l^s  directly  to  highly  optimized  formulas 
vrithout  We  need  of  deriving  them  from  more  general  notions. 

We  now  study  the  eff^  of  tbe  decompositidn  (30)  on  the  moltiplication  of  two  differ¬ 
ential  maps.  Maltipiicatioa  of  all  terms  pves  rise  to  live  basic  operations  which  have  to  be 
carried  out  to  obtain  again  the  decompoution  introduced  in  £q.  (30): 

m _ 

Iw] 

01  in 

By  further  scrutinizing  these  terms,  one  finds  the  following  properties: 

|(1)|  This  is  a  general  sparse  matrix  product.  It  consists  of  a  symbolical  part,  where  the 
storage  scheme  of  the  resulting  matrix  is  created,  and  a  numerical  part,  where  the 
actual  calculations  are  carried  out  (Pissanetzky  1984).  The  symbolical  part  is  carried 
out  only  once  at  the  begbnUg  of  the  analyris,  whereas  the  numerical  part  is  evaluated 
repeat^y,  but  only  for  non-vanishing  factors.  For  example,  the  numerical  part  of  the 
product  in  Eq.  (25)  indeed  only  impUes  the  operatioru  described  in  Equations  (26) 
and  (27). 


I  Here,  columns  of  which  are  at  the  same  time  outputs  of  are  removed. 


I  By  this  operation,  rows  of  ^4,  which  are  at  the  same  time  outputs  of  pa  should 
be  removed.  However,  because  no  two  mechanical  components  can  contain  identical 
output  variables,  and  do  not  tbare  rows  with  nonzero  elements  and  thus 
this  operation  is  immaterial. 


|(4)|  At  this  place  two  sparse  matnces  ipg,  ^ added.  However,  the 

non-zero  fftlnmiit  of  must  also  be  non-zero  columns  of  •  ^d,  within 

these  columns,  the  only  non-zero  elements  are  those  corresponding  to  cases  where  an 
output  (row)  of  <pa  matches  an  input  (column)  of  <pb  .  On  the  other  band,  the  only 
non-zero  columns  of  ve  those  which  are  also  non-zero  in  ^0, ,  but  do 

not  correspond  to  the  outputs  of  pA  •  Thus,  there  are  no  common  non-zero  elements 
between  (^0,09^,  and  V0,e/»4  *  so  this  term  also  does  not  give  rise  to  “true’* 
operations. 


j(5)j  Ag^,  two  sparse  matrices  Vo,  «(/**+ V.*.)  v*,  are  formally  added.  However, 

the  outputs  (rows  with  non-zero  elements  outside  of  the  diagonal)  of  ^5,  »(/yA‘f9^,) 
correspond  to  the  outputs  of  (pg,,  which  can  not  be  at  the  same  time  outputs  of  . 
Thus,  PB»«{I<fA+^A»)  <Pa,  do  not  share  rows  with  uonvanishing  elements, 
and  this  operation  is  also  free  of  numencal  effort. 
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Thus,  only  the  **keniel”  opention  |(1)  |  involving  the  very  few  nonzero  entries  outside  of 
the  diagonnis  consumes  computation  time  and  it  is  possible  to  design  automatic  schemes 
which  have  the  same  effidency  as  hand^coded  methods.  A  further  appealing  property  of 
this  approach  is  that  It  fits  neatly  into  the  “climit /server’*  model  introduced  above,  and 
that  it  is  not  dependent  on  intern^  representation  details.  Indeed,  all  that  is  needed  for  its 
implmentatiott  is  the  support  of  two  further  functions  ^do^yabelics”  and  ‘‘dojtuiierics’’ 
in  extension  to  the  basic  functions  of  Idnetostatical  transmisuon  elements. 

3.4.  FORWARDS-  AND  BACKWARDS-PROPAOATION 

The  general  scheme  for  the  calculation  of  Jacoblans  still  leaves  some  topiu  open  concerning 
the  eventual  form  of  the  operations.  By  studying  aU  methodolo^des  applied  in  robotiu  for 
the  evaluation  of  Jacoblans,  it  turns  out  that  three  bade  features  determine  the  type  of 
a  particular  algorithm.  Thme  are  (I)  the  reference  point  for  the  linear  velocity,  (2)  the 
frame  of  decomposition  for  the  vectors,  and  (3)  the  sequence  in  which  multiplication  is 
carried  out.  For  the  first  two  issues,  typical  sdections  are  (a)  the  inertial  frame  ACo ,  (b) 
the  body^Axed  frame  fCi  and  (c)  an  intermediate  frame  Kt  located  between  the  inertial 
and  end^effector  frame.  For  the  third  choice  mainly  two  alternatives  are  regarded:  the 
*'jBAcktMfifr’''propagating  multiplication  scheme 

V?  =  (M) 

and  the  '‘J^orvenfr’-propagatlng  scheme 

V>r  =  •((^j.»(V>j.«Vt.)))  •  (35) 

In  the  bachwardS'propating  scheme,  computations  are  buicaUy  performed  from  the  tips  of 
the  branches  of  the  system  to  the  inertial  frame.  Only  the  spatial  transformations  between 
the  tips  and  the  intermediate  frames  are  evaluated  here,  and  the  local  Jacoblans  are 
then  transformed  in  one  step  to  the  frames  at  the  tips.  In  contrut  to  this,  in  the  forward* 
propagating  scheme  also  all  spatial  transformations  between  the  inner  frames,  as  well  as 
the  representations  of  the  Jacoblans  m  all  subsequent  frames  are  evaluated.  This  is  shown 
in  Table  1,  where  one  may  assume  that  AC*  is  an  end*effector  frame  and  AC)  is  a  base 
frame.  A  good  vehicle  for  the  systematic  treatment  of  the  multiplication  schemes  is  the 


Table  1:  Intermediate  terms  of  the  forwards*  and  backwards  propagation  schemes 

concept  of  the  hmory  tree  (Knuth  1973),  in  which  each  node  has  either  exactly  two  or  no 
successors.  Nodes  without  successors  represent  the  '^leaves”  of  the  trees,  while  a  regular 
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Qode  represents  nn  intermediate  expression  resulting  from  the  product  of  the  left  and  the 
right  successor.  In-the  setting  of  the  evaluation  of  Jacobians,  the  leaves  correspond  to 
the  operations  of  t'globalulng”  pven  local  JaoobUns,  while  the  regular  nodes  represent  the 
intermediate  products  in  a  sequence  of  transmission  elements.  In  particular,  the  backwards* 
and  forwards*prop^ating  schemes  have  a  vtfy  rimple  representation  as  a  *‘left*biased''  and 
a  “nght^biased"  binary  tree,  respectively  (Fig.  8). 


a)  backwardS'propagatiog  scheme  b)  forwards^propagating  scheme 

Figure  8:  6ioary*tree  structures  for  basic  multiplication  schemes 


4.  Reeulie 

4.1.  KINEMATICS 

The  discussed  scheme  for  Jacobian  generation  has  been  applied  to  the  kinematics  of  an 
unbranched  chain  of  rcvolute  and  prismatic  j^ts,  as  It  is  typical  in  robotics.  Of  the 
different  posribilities  of  the  combinations  of  reference  point,  decomposition  frame  and  order 
of  multiplication,  five  correspond  to  known  approaches  from  the  literature,  whereas  two  are 
new  and  introduced  here  for  the  first  time  (Tbble  2).  Another  five  combinations  (the  empty 
fields)  are  not  farther  analyied,  as  their  practical  benefit  is  not  evident.  This  is  because 
the  reference  frame  Kt  of  ^naud  1981  lies  apprmcimately  in  the  middle  of  the  chain,  from 
where  a  forwards-propagating  composition  Is  starts  towards  the  ends  of  the  two  resulting 
subchains,  and  a  combination  with  representations  in  Ao  or  Ki  is  too  complicated. 

For  the  methods  described  in  Tbble  2,  a  comprehensive  operation  count  was  performed 
m  Knipp  1992.  Here,  only  the  results  for  a  serial  chain  of  n  revoiute  joints  intermixed 
with  correeponding  ripd  links  ~  is  summarised  in  Thble  3.  For  the  calculation,  the  well- 
known  D&NAViT'HAKTENBCRC-parametruation  for  ripd-body  motion  was  applied.  The 
results  are  given  both  for  the  case  that  only  the  Jacobian  of  the  end-effector  (the  frame  at 
the  end  of  the  chain)  or  also  of  every  frame  at  the  base  of  each  hnk  is  needed.  The  numbers 
m  parenthesis  correspond  to  a  chain  with  n  =  6 .  One  can  appreciate  that,  besides  the 
method  of  Waldron  1981,  every  method  for  calculating  all  intermediate  Jacobi^nl  involves 
O(n’)  operations.  Also,  one  can  jee  that  for  the  forwards-propagating  methods,  the 
evaluation  of  the  end-effector  Jacobian  affords  the  same  number  of  operations  as  calculating 
all  intermediate  Jacobians  as  well.  Finally,  note  that  Method  I  is  most  efficient  when  all 
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Refereace  pomt  for  velocity 


ATd 


Frame  of 
decompoutioo 


F:  fowarda^propagation 


B:  backwarda>propagatioQ 


Table  2:  Bactc  metboda  for  Jacobian  evaluation 


intermediate  Jacobiani  and  a  decompoiition  in  the  corretponding  body*ftxed  frames  it 
needed.  Similarly,  Method  U  it  most  effiaent  when  only  the  Jacobian  of  the  end*effector 
and  a  decompotition  of  vectors  in  thit  frame  it  needed.  This  shows  that  the  new  Methods 
I  and  n  may  be  interesting  for  dynamics,  because  in  this  case  the  costly  transformation  of 
inertia  properties  to  the  inertial  frame  it  avoided. 


Mtthod 

Vakobratevd/ 
PotkBBjak  19TS 

Oris/ 

Schrader  mi 

Oboa/ 

Rlbldc  19S2 

oaly 

H«’  +  J4»  +  4 

Hn~U 

TSii-lT 

cad-tfectoc 

(•«) 

(iK) 

(«*) 

•U 

Hn’+J,«  +  , 

Um’  +  JSn-t-U 

,«’  +  I2»-lT 

£rsm«a 

(MJ) 

(UTJ) 

(W>) 

cad-dtector  i  (3«) _ (W) _ (tit) 

•II  I  Boliappomd  +  24e*  +  54n-t0 

{flaw  I _ (tW _ (list) 

Table  3:  Numerical  effort  of  the  basic  Jacobian  evaluation  schemes 
4.2.  DYNAMICS 

As  an  application  of  the  described  method  to  the  problem  of  generation  of  the  equations 
of  motion,  consider  a  branched  system  of  bnks  hinged  to  each  other  by  revolute  joints, 
where  a  ‘‘shaft”  with  two  joints  is  connected  to  the  inertial  frame,  at  the  end  of  which  five 
further  serial  chains  are  attached,  four  of  them  having  three,  and  one  of  them  having  four 
degrees  of  freedom.  For  this  system,  three  buic  methods  for  generation  of  the  dynamical 
equations  where  applied:  (a)  the  composite  npid^hody  method  of  Walker  and  Onn  1982, 
(b)  the  ariicvlated-body  method  of  Featherstone  1987,  and  (c)  the  Jacobian-based  method 
descnbed  for  example  in  Nikravesh  1988  Out  of  these,  only  the  third  vanant  shall  be 
shortly  described,  as  the  other  two  are  most  well  known  in  the  dynamics  and  robotics 
community. 
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For  each  ripd  body  5; ,  its  inertia  properties  ca&  be  assumed  to  be  given  with  respect 
to  an  arbitrary  point  P; .  Denoting  by  the  v^odty  twist  of  Bt  at  and  by  w^^  the 
resulting  wrench  of  all  applied  forces  and  torques  at  Bt  with  respect  to  P, ,  the  pnnciple 
of  virtual  velocities  (Kane  and  Levinson  1985)  is 

Et(S,.i,.+W-wV,ril,,=0  .  (36) 

(■1 

where  *>•  is  the  number  of  bodies,  and  and  are  the  '^ipattal'*  analogous  of  the 
tensor  of  inertia  and  the  vector  of  eotiolis  and  centrifugal  forces,  defined  as 

S,.  =  [  .4,.  =  [  “"I®""'  J  .  (37) 

and  p^rs,  is  the  radius  vector  from  P^  to  the  center  of  gravity  Si  of  Bi.  By  substituting 

'  (38) 

where  ^  =  (fi ,  ,  q/F  represent  the  (independent)  generalized  coordinates,  and  taking 

into  consideration  the  independency  of  virtual  displacements  ,  the  equations  of  motion 
in  minimal  coordinates 

M(jl)j  +  fc{S.S)‘=fi(itS)  .  (39) 

result,  where 

M(,)  =  i;jJ.a,.j,, ,  4(j,s)  =  i:/J.<SAJAS+i»,) .  a(i.i)  =  E-'J,sV,  .(40) 


With  the  notation 

9  =  diag{Sn,.-.:..E,,,0,....0}  .  (41) 

i  =  +  -W^,  -w^_  ,  0, op  ,  (42) 

the  complete  set  of  equations  can  be  written  compactly  as 

+  V«7i  =  0  •  (43) 

The  implementation  of  all  three  methods  was  easily  possible  based  on  our  existing 
object-oriented  programming  environment  for  muittbody  systems  named  “MnBILE”. 


I  composite  ri^d-body  0.58 

articulated  body  0.52 

I  Jacobian-based  0.51 

'Os  SB  ApoUo  DH  3500 

Table  4'  Computation  time  for  one  set  of  equations  of  motion 


Table  4  shows  the  resulting  computation  time  for  generation  and  resolution  (determination 
of  generalized  accelerations  £)  ofone  complete  set  ofequations  of  motions  In  this  table,  not 


all  poMible  optizDuatioof  (special  treatment  of  first  and  last  bodies  m  the  chain,  elimination 
of  operations  involWng  zero  coeffidents  contained  in  the  local  Jacobians)  where  carried  ont. 
However,  all  methods  where  treated  similarly.  Clearly,  the  Jacobian  method  is  the  most 
effideot  one,  evra.thongh  the  gain  as  compared  to  the  other  two  methods  is  very  small. 
However,  for  systems  containing  many  do^  mnlUbody  loops,  the  advantage  of  using  the 
Jacobian*based  methi^  for  generation  of  equations  of  motion  will  in  general  be  higher. 

S.  Conelnaionn 

The  proposed  method  for  modelling  Jacobians  in  multibody  systems  sstablithes  a  unified  and  general 
formulation  which  is  also  weU-euited  for  object*orieaUd  programming  techniques.  The  underlying 
dtfferential*|eometric  interpretation  gives  a  means  of  extendug  the  concept  of  kinetoatatic  trana> 
nuseion  to  more  general  notions  while  at  the  same  time  hiding  the  implementation  details  from  the 
user.  This  renders  an  “easy^to-grasp*  intuitive  int^ace,  which  is  weihsuited  for  rapid  prototyping 
of  mechamsms  and  complex  multibody  systems.  Ths  novel  spam  matrix  storage  scheme  introduces 
an  alternative  approach  for  storing  the  interconnection  structure  of  multibody  systems  which  is 
*nearer"  to  the  formula  level  then  other  gr^b-theoretie  methods  Finally,  two  new  computation 
vananis  for  the  evaluation  of  Jacobiana  are  preaentad.  which  consume  leas  operationa  than  thoae 
publiibed  previously  in  the  case  that  all  vector  quantities  are  decomposed  in  the  body*fixed  framea. 
This  malm  the  ^proach  interesting  for  multibody  dynaimes.  a  topic  which  shall  be  discussed  in 
more  detdl  in  the  near  future 
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ABSTRACT.  The  object-oriented  modeling  language  Oymola  allows  the  physical  modeling  of  large  n- 
terconnectad  systems  based  on  model  components  from  difftrtnt  cnpincennp  domsina  It  geniraies 
symioftc  code  for  different  target  simulators  In  this  paper,  a  Dymola  elau  library  for  the  efFicicnt 
generetion  of  the  equetiont  of  motion  for  multibody  systems  is  presented  The  library  is  based  on  a 
reformulated  0(n}  algorithm  such  that  the  algorithm  is  truly  object-oriented  This  feature  can  also  be 
intarprcted  as  a  bond  graph  wientad  modeling  of  multibody  systems  Furthermore  a  new  algorithm  for  a 
certain  class  of  eenei/c  stmctare  multibody  systems  is  presented,  which  allows  the  generation  of  efficient 
symbolic  code 


1  Introduction 


Dymola  (6,  8,  3,  4|  is  an  object-oriented  modeling  language  for  modeling  of  large  dynami¬ 
cal  systems.  Models  are  hierarchically  decomposed  into  submodels  which  are  connected  in 
accordance  with  the  physical  coupling  of  the  components.  The  features  of  Dymola  allow 
the  development  of  domain  specific  class-hbranes  for  e  g.  electronic  circuits,  control  sy¬ 
stems.  hydraulic  systems,  thermodynamics  systems,  bond  graphs  and  others,  which  can  ail 
be  used  in  conjunction  for  generating  a  specific  multi-domain  application  model  Dymola 
generates  efficient  symbolic  code  for  several  target  simulators^  It  can  handle  ordinary 
differential  equation  models  as  well  as  differential-algebraic  equation  (DAE)  models  If 
a  DAE  IS  of  higher  index,  certain  parts  of  the  equations  are  sym  ^oiically  differentiated 
according  to  the  algorithm  of  Pantelides  [22] 

‘Presently,  Dymola  supports  ACSL(18].  DESIRE(13).  SlMNON{7]  SlMULINK(161  and  plain  Fortran 
in  cither  Stmnon-  or  DSblock-format{20] 


\ 
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in  this  paper  it  is  shown  how  variable  structure  muitibody  systems  can  be  modeled  by 
Oymola.  For  this  purpose  a  Dymoia  library  based  on  the  recursive  0(n)  algorithm  of  [Ij  is 
explained  in  detail.  The  algorithm  had  to  be  slightly  modified  in  order  to  arrive  at  a  “truly" 
object'oriented  formulation  as  enMuraged  by  Oynt^a.  .*‘Truly“  object*oriented  means,  that 
physical  objects'of  -the  ..'rultibody  system  are  mapped  to  corresponding  Dymoia  objects, 
which^are  conne^ed  in  accordance, with;the1physical'Coupling-of  the  5ysterh'(this  is  no 
block'diagram  represenfation  of  input/output  blocks).  The  clau  description  of  an  object 
contains.tKe  equations  that  describe  the  object,  and  the  cuf>definition,  i.e.,  a  definition  of 
the  interface  of  that  object  to  other  objects.  Due  to  this  procedure,  the  equations  of  motion 
of  a  muitibody  systcm  are  determined  by  Oymola  u«ng  only  the  connection  structure  of 
objects  and  the  /oca/ information^about  objects.  It  turns  out  that  this  ilescription  form 
has  close  connections  to  the  bond  graph  methodology  |26. 3].  In  fact,  this  object-oriented 
definition  of  a  muitibody  system  can  be  interpreted  as  a  multibody  bond  graphs 

Besides  a  reformulation  of  an  0(n)  algorithm,  a  new  enhancement  of  this  algorithm  is  pre¬ 
sented  that  allows  the  efficient  treatment  of  a  certain. clau  of  variable  structure  systems, 
i.e..  systems  with  varying  de^ees  of  freedom.  In  the  last  years,  methods  to  handle  mul¬ 
tibody  systems  with  variable  structure  have  been  considerably  improved  (14.  24.  U,  10). 
Usually,  such  systems  are  modeled  by  numenco/  multibody  programs.  This  is  due  to  the 
fact  that,  if  rt  independent  switches  are  pruent  to  remove  or  add  one  degree  of  freedom. 
2**  different  Mnfigurations  are  pouible.,  For  example.  K  dry  friction  is  present  in  the  joints 
of  a  6  degree-of-freedom  (dof )  robot.  2*  s  64  configurations  are  pouible,  since  every  joint 
can  either  be  in  sliding  (s  1  dof)  or  in  sticking  (s  0  dof)  mode.  Numeucal  muitibody 
programs  are  designed  to  handle  a  large  clau  of  muitibody  systems  with  the  same  pro¬ 
gram.  If  such  a  feature  is  pruent,  it  is  not  principally  difficult  to  change  the  configuration 
(i.e..  the  multibody  system)  during  integration.  On  the  other  hand,  a  symbolic  multibody 
program  generates  code  for  a  specific  multibody  system  only.  Therefore.  2”  different  co¬ 
des  have  in  general  to  be  generated,  if  there  are  2"  pouible  configurations  (=  multibody 
systems).  Even  for  a  modutly  sized  multibody  system,  such  as  a  6  dof  robot  with  dry 
friction,  this  would  be  quite  impractical.  It  will  be  shown  that  a  simple  modification  of  the 
recursive  0(n)  algorithm  circumvents  this  difficulty  and  will  allow  the  symbolic  generation 
of  compact  and  efficient  code  for  variable  structure  systems. 

Oymola  together  with  its  muitibody  library  is  comparable  to  commercially  available  mul¬ 
tibody  programs  both  in  ternis  of  efficiency  and  ease-of-use.  However  as  already  noted. 
Dymoia  can  easily  model  components  from  other  engineering  domains  in  conjunction  with 
the  multibody  components  by  invoking  them  from  other  already  available  class  libraries. 
For  example,  a  sophisticated  library  for  electronic  components  corresponding  to  the  SPICE 
electronics  program  (19|  (diodes,  Zener  diodes,  tunnel  diodes,  BJTs.  JFets,  MosFets,  and 
CaAs  transistors)  is  being  developed  at  the  University  of  Arizona.  In  contrast  to  other 
multibody  programs,  Dymoia  supports  mu/lidtscip/mary  modeling  within  one  environment 

the  muitibody  part  being  just  one  modd  component  among  other  equally  important 
engineering  disciplines. 

^Someone  not  familur  with  the  bond  graph  methodology  can  just  skip  telated  paragraphs  in  this  paper 


2  Detailed  robot  model 


Dymoia  is  introduced  by  means  of  a  detailed  dynamic  model  of  the  industrial  robot  Manu- 
tec  rS  described  in  [9|.  The  structure  of  this  ^multldisaplmary''  model  is  shown  in  Figure  I 
The  6  degree*of«freeddrn  robot  consists  of  a  system  of  rigid  bodies  connected  by  ideal  re* 
volute  joints.  Every  joint  is  driven  by  a  torque,  produced  by  the  electro*magnetic  field  of 
a  current'ControKed  OGWtor  and  transformed  by  gear*boxe5.  The  motors  are  controlled 
by  decentralized  casca^de  controiiers>  The  block  "rotor+gear’  in  Figure  1  contains  the 
mechanical  part  of  a  motor  and  of  its  gear*box. 

Dymola  supports  a  hierarchical  decompostUonci  models.  The  Dymola  model  can  there* 
fore  be  designed  such  that  it  directly  reflects  the  model  structure  as  shown  by  the  following 
definition  of  the  robot  in  the  Dymola  model  language  indicates  similar  items  that 
have  been  omitted  in  order  to  shorten  the  text): 

QAdrokl.hi  {uM  library  lUrobct.lib) 
model  /Idroidt 

submodel  (RSeantnl)  ei,  ci,  eS,  <4f  cS 

submodel  mi  (RtisU0,JUts400,CsJ.£»6„-  .),  ..,m6(.  .) 

sMhmodtl  (RSfwA)  (<s4SJs0.e0S,fsfi,,.,), 
iuhtaodtl  (RSfterB)  f4  (p^P4»'’)>  $S(p^pS...),  $6(psp0„,.) 
submodel  rek^t  {multibody  system) 

coDstent  pistl0,  p0s0O,  p5e7P.f,  pds-PP 

input  fid.  fid,  fdd,  ffd,  fdd,  fid  {desired  arm  angles) 
input  v/d,  vid.  vdd,  v44,  vld,  vdd  {desired  arm  angular  velocities) 

connect  ci  to  ml  to  fi  to  rofcl;/ 

connect  eS  to  md  to  $0  to  rohUjS 

{Controller  input  =  gear*ratio  •  modebmput) 
ci.yd  s  pl«qld 
effd  s  p2«q2d 

cd.wd  =  p6«w6d 

end 


According  to  the  different  block  component  types  of  Figure  1,  model  classes  are  defined 
in  a  library  that  is  made  available  to  the  model  (object)  definition  through  the  command 
QRSrobot.hb  (the  ^  operator  tells  Dymola  to  include  the  file  RSrobot.hb).  New  models 
(or  objects)  of  these  class  definitions  are  instantiated  by  the  command' 

submodel  (class-name)  object-name  (parameters^  ... 

For  example  the  statement  ‘'submodel  (RScontrol)  cl,  c2,  cS,  c4,  c5,  ed*  instantiates 
SIX  identical  objects  of  the  same  class  RScontrol  This  is  meaningful  since,  in  the  R3 
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10] 


Figure  1:  Model  structure  of  Manutec  r3  robot 

robot,  six  identical  cascade  controllers  are  used.  In  contrast,  the  six  motors  of  the  robot 
have  the  same  structure  but  different  parameters.  Therefore  the  class  A5motori$  used  to 
describe  the  motor  structure,  whereas  a  specific  motor  is  defined  by  supplying  appropriate 
values  for  the  motor  parameters.  Since  the  robot  employs  gear*boxes  of  two  structurally 
different  kinds,  two  different  classes  RSgcarB)  are  provided.  Finally  an  object 

of  the  multibody  description  (i.e.,  the  robot  itself  without  the  motors,  gear-boxes  and 
controllers)  is  instantiated  from  class  RSmbs. 

With  the  statement  ‘‘constant  the  gear  ratios  p,  are  defined  as  constants 

They  are  used  in  two  different  places  (gear-box  and  input  of  controller).  With  the  state¬ 
ments  "input  qid..."  the  input  signals  of  the  overall  model  are  defined.  These  are  the 
desired  angles  and  angular  velocities  of  the  joints  as  input  to  the  controllers. 

All  the  objects  arc  assembled  by  the  connect  statements.  The  meaning  of  a  connect  sta¬ 
tement  such  as  “connect  ci  to  mi"  is  defined  In  the  corresponding  class  description,  as 
will  be  explained  below.  Note,  that  there  is  no  signal  direction  associated  with  a  connect 
statement.  It  is  therefore  not  an  input/output  block-diagram  description!  Instead,  the 
connect  statement  reflects  the  physical  coupling  of  components,  if  an  object  has  se¬ 
veral  different  interfaces,  also  called  cuts,  the  notation  ohjecUcut  is  used.  For  example, 
“connect  gl  to  roboUjr  states  that  gear-box  1  is  attached  at  cut  jl  (=:  joint  1)  of 
object  ro&ot.  At  the  end  of  the  model  description,  the  connections  between  the  global 
input  signals  and  the  model  are  specified.  For  example,  “ci.fd  s  pl*qld"  states  that  the 
input  variable  qd  of  controller  cl  is  the  desired  angle  qld  multiplied  by  the  gear-ratio  pi 
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To, this  point.-the  top'most  model  components  have  been  assembled.  We  shall  now  look 
at  the  component  modds  themselves'-  Motors  are  describe  by  objects  of  class  RSmotor. 
which  makes  use  of  a  basic  Oymola  library  for  electrical  components  such  as  resistors, 
capacitors,  and  operational  amplifiers  Let  us  first  have  a  look' at  one  of  the  classes  of 
this  library:.iri.order:to  get, familiar  with  some  important  concepts  of  Dymola.  In  the 
aforementioned  library^  a'  capacitor  is  defined  as  follows: 


model  claas.cepecirtfr 
parameter  C 
c\xtA(Vclt),B(Vh/~t) 
main  cut'  cAB[AtB] 
main  path  pAB  <A  •  B> 
local « 

Va-  Vh  =  u 
C«der^tt^  s  i 


A  capacitor  is  an  element  with  two  cuts  A  and  B,  through  which  it  can  be  connected 
to  other  elements.  With  each  cut  two  variables  are  associated,  the  potential  at  the  wire 
(Va,  Vh)  and  the  current  flowing  into  the  component  through  the  wire  ~i}.  Dymola 
distinguishes  between  two  types  of  variables:  across  and  ihrouph  variables,  in  a  cut 
declaration,  all  variables  to  the  left  of  the  slash  operator  (V")  *re  defined  to  be  across 
variables,  whereas  alt  variables  to  the  right  of  the  slash  operator  are  defined  to  be  through 
variables.  Accordingly,  the  potentials  Va,  Vh  are  considered  as  across  variables,  whereas 
the  current  t  is  a  through  variable.  The  difference  between  these  two  variable  types 
becomes  apparent  in  a  connection  only.  Assume  for  example,  that  three  elements  El,  E2, 
E3  with  the  above  cut^definition  arc  connected  at  one  node  as  indicated  in  Figure  2.  The 
Dymola  built*in  rules  will  generate  the  equations  indicated  in  Figure  2.  i.e.,  the  across 
variables  across  a  node  are  set  equal,  whereas  the  through  variables  through  a  node  are 
summed  up  to  zero.  These  are  exactly  the  physical  laws  that  apply  when  a  capacitor 
is  connected  to  other  electrical  elements.  The  statements  ''main  cut  ..."  and  "main 
path  ..."  in  the  capacitor  definition  state  the  default  connections  that  are  used  if  no 
cut-names  are  explicitly  specified  in  the  connect  statement.  For  example,  the  statement 
"connect  Cat  (nlftiSf  is  equivalent  to  the  longer  specification  "connect  C:A  at  nl, 
C:B  at  n2. 

The  physical  laws  of  the  capacitor  are  programmed  in  the  last  two  statements  using  the 
cut-variables  and  the  der  operator  that  characterizes  a  differential  An  important  feature 
of  Oymola  is  that  no  direction  is  associated  with  vanables.  Based  on  the  connection 
structure  of  the  overall  model  and  the  problem  description,  Dymola  will  di  rmme  on 
its  own  for  which  variable  each  of  the  equations  needs  to  be  solved,  and  ap  •  symbolic 
formula  manipulation  to  transform  the  equations  to  the  desired  form,  if  necessary.  Due 
to  this  feature.  Dymola  supports  the  use  of  true  equat%ons  rather  than  simple  assignment 
statements. 
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Let  us  n9W  return  to  the  robot  exainple.  Using  the  aforementioned  library  of  basic  electrical 
components,  the  motor  shown  in  Figure  3  can  be  defined  in  the  following  way 

model  clast 

'  submodel  (mutor)  Ril(Rs200).RdS(R=iO0),RiS(Rsm);Rd4(R=400) 
submodel  (rtsuior)  RtI(RsRtlJ,  Rtt(RsRtt),  Rt$(Rs$tO),  Rp(RsSOO)^  Ra(RsRa) 
submodel  (eifietier)  Ci(C=Ci) 
submodel  (in4%cier)  U(Ls:U) 

submodel  (tmf)  tmf(ksimoi)  {electto>motonc*force} 

submodel  (h'tll)  htUfksC)  {ball  sensor) 

submodel  (Of  Amp)  dtff,  PI  loperstionsl  amplifier) 

submodel  (C^AmpP)  paretr  {operational  amplifier) 

submodel  (^wd)  ^  ^ 

parameter  UssI.E-S,  kmctsS,4S,  R$I=410.  RiisSOO,  CtsJ.E»7 

cut  tUc  (Vd  /  id),  mtck  fry,  rv),  eea(n>l(me<&,  c/ec)  {cannechon  to  conintUr) 
cut  peer  fry,  no  / 1)  (conneetton  to  gear) 

mam  cut  c  (eaniro/,  year)  {deUult  connection  behaviour ) 

main  path  p  <  canlrol  -  year  >  {default  connection  behaviour) 


node  nO,  nl,  nt,  nS,  n4,  nS,  n6,  a7,  n$,  n9,  nlO,  nlj,  nil.  nJ$,  nI4 
connect  Adi  at  frtl.nd),  iUI  at  fnl.Al).  RdS  atfnl.nl,). 

Ri4ii  fnO.nl),  Ail  at  fn^.tid).  Ail  at  (nS, n7), 

Ailat  fnO.nl),  Ci  atfa7.nl,).  Ap  at  fnO.nlO/ 

As  at  fall, nil),  U  at  fall.all).  em/  at  fnll.nll) 

di^at  fal.ntnl), 

As/i  at  fall, nO.nl), 


All  at  (nS,n$),  Ail  at  (nS, n7), 

Ci  at  fa7.nl).  Ap  at  fnO.nlO), 

U  at  fall.all).  em/  at  fall, nil), 

PI  at  fad.ad,al),  peverat  fnl.nlO.nll), 
year  at  em/.mecA,  elec  at  nl,  y  at  nO 
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the  form  "connect  Rdl  at  /n^,n5/‘  means*  that  object  Rdl  is  placed  between  the  two 
nodes  ri2,  no.  In  the  sa'ine  way*  the  ptl*  .r-ciasses  RScontrolf  RS^earA  and  RSgearB  are 
defined]  but  th^  are  omitted  here^due  to  space  limitations.  Class  RSmbs,  to  describe 
the  rnechanicaj  (multi^dy)  part  of  the  robot,  is  discussed  after  deriving  the  Oymola  class 
library  for  multibody  systerns  in,  the  next  two  sections. 


3  Basic  cleisses  of  multibody  library 

The  rnost.^ifficuit. part  in  developing  a*  Oymola  library  is  the  selection  of  basic  objects 
as  abstract  mappings  of  their  physical  counterparts.  Here,  this  selection  is  based  on  the 
object-oriented  data  model  for  multibody  systems  of  |21).  The  most  fundamental  object  is 
a  coordinate  system,  or  frame,  as  shown  in  Figure  4  below.  A  frame  i  is  always  described 
with  respect  to  a  reference  frame  r  (=  re/(t)).  If  frame  i  is  not  moving  with  respect  to 


Figure  4:  Fundamental  Dymola  class  Frame 

frame  r,  the  two  frames  are  material  points  located  on  the  same  rigid  body.  If  there  is  a 
relative  motion  between  the  two  frames,  frame  i  describes  an  ideal  joint,  such  as  a  revolute 
or  spherical  joint  The  inertia/  system  is  the  special  frame  0,  where  the  movement  of  the 
frame  is  known  (=  is  at  rest)  and  is  therefore  the  only  frame,  which  has  no  reference  frame 
In  the  multibody  library,  class  Frame  describes  the  common  properties  of  all  different  frame 
types.  SpeciFc  frames,  such  as  class  Revolute  desaibing  a  revolute  joint,  are  derived  by 
inheritance  from  superclass  Frame. 
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.  The'm6vem«ntMfra,my  t'is  cosine  matrix  T,,  which 

.^tran^Mm^ten$prs\r^^Iyed’1n'frame  tVtnto'th'e'm'ertia)  frame;  and  the^ab'spiute.  position 
vwtw]^r;^which2i5-a«y  fromVthe  orT^^n  of  the  inemal  frame  td^the  origin 

^of{f«me  i.‘'EquiyaIently,*rthe‘mwement'of.f«  level  is  descried, by  the 

abMliite  a'hgular  velocity' w;  of  frame  t  and  the  absolve  fnear  velocity  v,*  of  the  origin  of 
this  frame/  If  the  rhovenient  of  the  reference  frame  r  is  known,  the  movement  of  frame  t 
<»n'be  ulculatt^.'^giveri  the  expressions  for  the  relative  motion. 

At  the  , origin  of  frame  iV  a’force  ^'  and  a  twqiie  r,  are  ading  These  two  quantities 
result  from  cutting  forces  and  torques  as  well  cs  from  internally  appli^  forces  and  torques 
.  aiding  b'etWMh  frarne  t  and  frame  r.^  For  hotatipnal  convenience;  these  two  quantities  are 
concatenated  into  a^jreniira/ufed  /dfce  vector  f^/and  equally'are  the  aiigular  and  linear 
velocity. of  a  frame  conutenated  into  a  jr^nero/ieed  velocity  vector  v,*: 


With  these  preambles,  Figure  4  can  now  be  discussed  in  more  detail.  In  the  top  part, 
frame  i  and  its  reference  frame  r  are  shown.  Vector  v,  characterites  the  movement  of 
frame  i,  whereas  vector  fj  characterizes  the  generalued  force  acting  on  frame  t.  Frame  i 
can  be  viewed  as  a  traru/ofmer element  that  transforms  the  ’‘movement”  of  frame  r  to 
the  “movement"  <ti  of  frame  t  and  the  force  acting  on  frame  t  to  force  acting  with 
negative  sign  (due  to  the  actiosreactio  principle)  on  frame  r  using  the  usual  transformation 
rules  for  velocities  and  forces. 

The  lower  left  part  of  Figure  4  depicts  the  corresponding  Dymola  object.  This  object  has 
three  cuts  (A.BX).  which  are  used  to  connect  the  object  to  other  objects.  Cut  C  will  be 
explained  in.  more  detail  below.  Every  cut  is  a  collection  of  several  variables.  The  most 
important  ones  are  shown  in  the  figure.  Note  that  there  is  vo  (input/output)  direction 
associated  with  the  variables  of  a  cut.  Dymola  determines  this  information  by  itself,  based 
on  the  connection  structure  and  the  problem  deKfiption. 

Two  or  more  cuts  can  be  connected  at  one  node.  As  already  noted,  Dymola  has  two  built- 
in  rules  for  such  a  connection,  Across  variables  are  identical,  whereas  through  variables 
sum  up  to  zero.  Due  to  the  cut-principle  in  mechanics,  alt  kinematic  quantities  of  a  cut 
(=  position,  velocity,  acceleration)  are  treated  as  across  variables,  whereas  the  forces 
are  treated  through  variables.  See  for  example  Figure  6:  Frame  F2  is  the  reference 
frame  of  frames  Fs  and  F4.  Cut  B  of  frame  Fj  and  cut  A  of  frames  Fs^Fi  are  therefore 
coniiei.ted.  he  kinematic  variables  of  these  three  cuts  are  identical  since  th*y  describe 
the  rnovemen^  of  the  reference  frame  Ft.  On  the  other  hand,  the  forces  sum  up  to  zero, 
i.e.,  fj  -  ^3(3)  -  f3(4)  ss  0. 

Finally,  the  lower  right  part  of  Figure  4  shows  the  bond  graph  representation  of  a  frame. 
Except  for  the  (unusual)  additional  bond  corresponding  to  cut  C.  a  frame  can  be  viewed 
as  a  moduluted  transformer  TF,  transporting  the  power  from  frame  r  to  frame  2 
without  storing  energy. 
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Until  nw,'  the.d^ription^of  dau  Frame, was  rather  informal;  To  arrive  at'a  rigorous 
^ecWcation^  by  dilations,  some  further  d^nitions  are  necessary:  Matrix  E  is  the  identity 
inatrlx.  The  wordinatW  of  a  vector  h;,^which'is  resolved  in  frame  j,  is  given  as  a  column 
vector  If  i  =  j,  index  j  can  be, removed,  i  e.,  h;  is  the  vector  hi  resolved  in  frame  i. 
Additionally,  operator  sbetu  and  its  inverse  tree  are  defined  as(h  isa  (3x1)  column  vector, 
H  is  a  skew-symmetric  (3  x  3)  matrix)' 


H  =  skew(h)  s  skew( 

[All 

■:Aa- 

),='< 

0  -Aa  Aj  ' 

Aa  0  -A, 

As 

_  —Aj  hi  0 

h  =  uec(H) 


It  is  assum^  f  hat  frame  i  has  li,-  degrees  of  freedom  (0  <  n,  <  6)  with  respect  to  frame  r 
and  that  ni  generalize  coordinates  q,(l)  are  used  to  uniquely  describe  the  relative  motion 
e  fume  i  with  resp««  to  its  reference  frame  r  (eg,  for  a  frame  describing  a  revolute 
joint,  q;  is  the  rotation  angle  of  the  joint).  Therefore,  the  relative  direction  cosine  matrix 
T,’'‘(q,),  describing  the  orientation  of  frame  i  with  respect  to  frame  r,  and  the  relative 
position  vector  r;*'(qi),  pointing  from.the  origin  of  frame  r  to  the  origin  of  frame  i,  are 
functions  of  the  generalized  coordinates  q,-  only  This  functional  dependency  it  defined  in 
the  corrWponding  subclass  of  superclass  Frame,  e.g.  in  class  Revohte  to  describe  a  revo¬ 
lute  joint.  Using  these  definitions,  an  object  of  clau  Frame  is  described  by  the  following 
equations,  utilizing  the  usual  relations  for  relative  kinematics,  force  transformations  and 
d’Alembert  principle  (see,  for  example  (251),  “  “  *  no«l  matrix  L,  to  define  the 

variable  structure  of  the  system; 


where 


C.(q.)  = 
^.(q..4."^)  = 


T,  = 

T^Xr'*' 

(la) 

°r,  = 

'’rr'fX/r"' 

(lb) 

V,  = 

C.v,  -P  #.q, 

(Ic) 

a,  = 

C,a,  -f  #,q,  -f- 

(Id) 

ff(i»  = 

eff, 

(le) 

k:-hL.A!  = 

(If), 

0  = 

L.q.-h(B-L,)A; 

(Ig) 

P.  = 

-f- 

(Ih) 

V'"  -  f  ] 

f  XT**  0  1  r  vec  1 

-  [  0  t:«'  j  [  -r:"  j 

(2a) 

f  TC'  0 

E  0  1 

(2b) 

[  0  T”' 

-siew('r;'<)  E  J 

f  t;"  0 

Ufr  X  1  . 

(2c) 

[  0  t;*' 

Ur  X  («,  X  ■'rj''  -f  2’'v"')  J  + 

*as((A«).). 

=  if  locked  then  1  eke  0 

(2d) 

I 

3 

I 

1 

I 

I 

■I 

i 
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„Let  us^iscutt  these  equations  one  after  the  other.  Equation  (la)  states,  that  the  direction 
■cosine  , rnaUix*T,*i'of  ffa^^^  t  is  »iculaUd-using  the  direction  cosine  matrix  of  the  reference 
fra'me  r^andjthe  relative "dire^iqn  cosine-matrixVwhich  is  only  a'function  of  q,.  in  the 
.‘samelway, \the  abMlute:pps'4tion  vMtor’-?r.':cf>frame  iv  rhich  is  resolved  In  the  inertial 
^frame;  is  calculate  usjhg.the  absolute  position  of  frame  r  and  the  relative  position 
vector  comiecting  the  two  frames. 

Thel^solute  position.  vector  ?r..is  resolved  inithe  inertial  frame,  whereas  all  the  other 
variables.;  e.g.'^veiocitiu  and  forces,  are  resolved  in  the.corresponding.frarhes  (t  or  r)  The 
reasoh'for  this'is.that  thr  position  vector  is.e.g.  needed  in  kinematic  analysis  problems 
or  to  determine  animation  data.  In  such  problems,  the  vector.has  to  be  resoUed  in  the 
ineitjahfrarne.  \0n  the  other- hand^velocities.^'accelerations  and  forces  are  utilized  in 
dynamic, analysis  problems.'For  the  most  important  of  these  applications,  i.e.,  the  direct 
kinetics  problem,  a  detailed. analysis  of  a  certain  class  of  multibody  systems  described  in 
[12]  unveils  that  the  0(n)  algorithm  yields  more  efficient  code  when  the  calculation  is 
perforrned  in  bodyffixed  coordinate  systems  rather  than  the  inertial  system.  Furthermore, 
it  is  rnore  natural  to  resolve  forces  in  bodyffixed  frames  since  the  directions  of  the  forces 
, can  .be  associated  with^geometric  properties  of  the  corresponding  component.  Using 
the  rnultibbdy  library,  it  is  of  course  easily  feasible  to  resolve  every  vector  in  any  desired 
coordinate  system  since  the  absolute  direction  cosine  matrix  of  every  frame  is  determined^ 

Equation  (Ic)  states  that  the  absolute  .velocity  ^j.of.frame.t,  resolved  in  frame  t  is 
calculated  using  the  absolute  veloct^  of  frame  r  and  the  relative  velocity  of  frame  t  with 
respect  to  frame  r.  Equation  (Id)  states  the  same  fact  for  the  absolute  acceleration  a, 
of  frame  i.  These  two  equations  have  been  derived  by  differentiating  equations  (la. lb) 
twice,  using  the  following  definitions: 


Equation  (le)  indicates  how  the  force  f«  acting  on  frame  ;  is  transformed  to  frame  r 
Note  that,  for  this  transformation,  the  same  (but  transposed)  matrix  C,  is  used  that  is 
also  utilized  in  the  kinematic  equations.  Equation  (If)  is  an  important  equation  relating 
forces  and  kinematics  based  on  the  d'Alembert  pnnciple.  Neglecting  the  term  L.Al  for  the 
moment,  this  equation  states  that  the  generalized  force  f.  acting  on  frame  t  and  projected 
onto  the  free  direction  of  the  frame  U  the  generalized  applied  force  Af  acting  between 
the  two  frames^.  If  no  generalized  applied  force  A*  is  present,  f,  =  0,  i.e.,  f,  consists 
of  6  -  n,  independent  coordinates  only  the  constraint  forces  in  the  joint. 

^Tht  Oymoia  translator  hai  an  option,  that  all aquattona  ar«  removH  which  arc  not  needed  to  compute 
the  desired  o«(p«r  variables  Therefore,  equations  (la.lb)  do  not  show  up  in  the  generaad  code  if 
e  c  no  animation  data  are  needed  and  if  no  force  dements  arc  present 

^If  the  frame  desc*ibes  a  revolute  joint,  for  example.  rs  thv  applied  torque  acting  along  the  axis  of 
rotation  n,.  whereas  Vt  ^  (of  O]^ 


too 


£qu4ti6n,(lg}.is  used  to  describe  the  variable  structure  of  the  frame  in  the  following  sense. 
It  is.assuiTiM'thaVev^jy  single  Jdegree>of*freedom  (dof)  of  the  frame  can  be  locked,  i.e.. 
the . co'crVfppnding  ^nera!ized;cbdrdinates. are  fixed:(q,-.  s  const).  whereas  the  first  and 
secpnd,derivatiy<a  of  these  coordinates  are  set  to  zero.  In  such  a  situation,  an  additional 
constraint  force  Ajthas<to^be^applied  that  acts. inithe  same  direction-as  the  generalized 
applied  force  X%  The  tvra  possible  states  (fr^/locked)  are  defined  by.the  diagonal  matrix 
the'j*th'diafonal''eIeffl'ehVof  Tr  is  oneAhe  htl^tdof  b  iockedi.  If  it  is  zero,  the  j«th 


^lockedicahd  that  otherwise  the' constraint  forces  A;  as  0.  During  iritegration...matrix  L, 
remains  constant.  Jbe  matrix  rhay  charige  its  value  only  before  the  integration  starts  or 
immediately  after  an  event  has  occurred. 

Finally,  equation  (Ih)  states  that  the*  energy  flowing  into  the  frame^  is  the  same  as  the 
energy  flowing  out  of  the  frame  since  the  frame  does  not  store  energy.  This  equation  can 
easily  be  derived  from  equations  (Ic.Ie.lf). 

in  Figure  4,  the  bond  graph  of  a  frame  has  an  unusual  bond,  corresponding  to  cut  C. 
The  reason  is  that  variables  ff(i),Vr(fHV<  and  A^4  related  through  equations  (1). 
Since  these  relations  hold  for  every  single  frame  object,  a  bond  graph  would  become  very 
complex  if  this  structure  were  always  jhown  explicitly  using  basic  bond  graph  elements. 
For  simplicity,  it  was  therefore  decided  to  generalize  the  tnns/omer  element  instead. 

Usually,  bonds  transmit  only  efort  and  flow  variables.  This  is  not  the  case  in  the  multibody 
bond  graph.  Here,  the  position  (s  integral  of  the  flow  variable)  and  the  acceleration  (» 
derivative  of  the  flow  variable)  arc  also  transmitted,  due  to  equations  (la.Ib.ld).  There  are 
two  reasons  for  this^dccision:  First  of  all.  the  integral  of  the  flow  variable  does  not  always 
exist,  since  In  a  general  thr^dimcnsio.nal  movement,  the  angular  velocity  is  r*ot  integrable 
to  a  position  coordinate*.  Secondly,  nearly  all  multibody  systems  represent  hi^herrindex 
differential  algebraic  cquatbns  (DAE)  if  the  wnection  of  bond  graph  element  s  done  on 
velocity  level  only.  The  explicit  usage  of  the  additional  position  and  acceleration  variables 
can  be  viewed  as  an  application  of  the  general  "dummy  derivative”  technique  to  reduce 
the  index  of  a  DAE  (4.'  17J.*  In  this  case,  the  equations  (la.lh)  were  manually  differentiated 
and  included  as  (Ic.ld).  Alternatively,  the  Pantelides  algorithm  [22]  could  have  been  used 
to  determine  what  equations  to  differentiate  in  order  to  reduce  the  index. 

it  is  straightforward  to  build  a  Dymola  cta»  description  based  on  equations  (1).  For  this, 
equations  (1)  are  split  into  two  parts.  At!  terms  depending  on  relative  quantities  (e.g 
or  #t)  ere  defined  in  an  appropriate  subclass  (e.g.  class  Revolute  for  revolute  joints), 
whereas  all  other  equations  are  defined  in  the  common  superclass  Frome. 

Class  Frame  allows  a  rather  general  description  of  joints.  Also,  rheonomte  joints  are 
included  in  the  description  although  T^*^(q«)  and  ^'^(q.)  do  not  explbtly  depend  on 
time.  This  is  due  to  the  fact  that,  in  the  a^ve  equations,  it  is  not  defined  what  is  known 

*Pow«f  P  »  fflcffy  flow 

*inst«ad  of  the  integral  of  the  "criticar  flow  variable  (=  angular  velocity),  the  closely  related  direction 
cosine  matrix  T.  is  used,  see  equation  (3) 


101 


;^an4;yvhat.t$  unknown.'  For  example.  anxbj^  of  class  Aevo/ufe  ts  used  as  revolute  Joint 
ifqvjs^unknotm'whereas^qrt^'t^f  are  known.'On.the  other  hand,  an  object  of  the  same 
.class  is/used'as'  pure:rh^nomic  joint  if  q,-,  q),  q;'are  knwn  functions'  of  time  whereas  Af 

description  for  different  problems  is  one 
jofx\h^most  irnpohant  st/en^hs  of  the:Dymola  m'dde[ing'language. 

in^oKderTto  be  able  ^'dtfcri^^^  <y<|«>ns.  a  few  additional  simple  classes 

a^e^Veeded'M  sK^h.in'Figu^^^  5.  Gau  J^dy  defines  the  mass  properties  of  a  n^id'body. 
'An^obj^t  of  this^clau  has  only ,bne .cut,  whic^  connected.at  either  cut  A  or  cut 

'  S’of^V  objKV of  class  Frame.  The  frame  at  which  an  object  of  class  ^ody  is  attached 
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Figure  Dymola  dasses  Body  and  Force 

is  usually  located  at  the  center  of  mass  of  the  corresponding  rigid  body,  but  it  can  also 
be  attached  to  any  other  point  on  the  body.  An  object  of  this  class  is  described  by  the 
following  equations  (see,  for  example  (25))* 


Fi^cw)  =  b,(cw) 


where 


b,(CAf)  = 
t/  = 


l/  m,skew{‘TcM) 
-m,sxew(*rcM)  m,B 

W,  X  if 

m,w,  X  (w,  X  *rcAf) 


If  =  'IcM  -  m,$ketDi*rcKi)skew{*rcM) 


(4) 

(5a) 

(5b) 

(5c) 
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Equation  4  incorporates  the  Newtoh-Eufer  equations,  i.e..  it  states  that  the  derivatives  of 
the  generalized  rhbmenta  of  a  body  are  equal  to  the  resultant  generalized  forces  f,(c.u)  ac¬ 
ting  at  the  reference  point  used  for  the  rnomentum  balance.  In  Figure  5,  the  corresponding 
bond  gra'phri  O’.  the  bond  graph  inertia  element  I.  is  shown. 

Firialiy,  class  Force  (cf.  Figure  5)  describe  a  force  element.  Simifarily  to  class  Frame, 
class  Force  is  the  superclass  of  all  force  elements  containing  their  common  properties  A 
specific  force  element,  such  as  a  springs  is  a  subdass  of  class  Force.  An  object  of  this  class 
always  acts  between  two  different  frames  and  has  therefore  tvro  cuts  with  which  the  object 
IS  connected  to  the  two  frames.  The  absolute  p^ition  and  the  absolute  velocity  variables 
of  these  ^  frames  are  usually  utilized  to  compute  the  rejatiye  position  and  the  r.>fative 
velocity  variables,  which  in  turn  are  use'd  to  forrhulate  ihe'force  law',  i.e..  to  calculate  the 
applied  force  and  torque  acting  on  the  tiw  frames. 

In  the  muitibody  library  of  Dymola.  some  additional  classes  aredefined.  e  g.  class  Scnsorto 
measure  kinematic  quantities  between  two  frames.  Since  these  classes  are  not  important 
in  the  context  of  this  paper,  they  are  not  descr.bed  here.  An  example  of  a  multibody 
system  is  given  in  Figure  6.  In  the  top  part,  an  abstract  picture  of  the  muitibody  system 
is  presented.  The  center  part  shows  the  corresponding  Dymola  objects  together  with  their 
connection  structure.  The  bottom  part  displays  the  bond  graph  of  the  multibody  system. 

The  dasses  introduced  so  far  are  sufficient  to  describe  rigid  multibody  systems  with  open 
and  dosed  kinematic  loops  as  well  as  arbitrary  force  elements.  Depending  on  what  are 
the  known  and  unknown  variables.  Oymda  can  generate  different  types  of  simulation 
models  from  a  general  topological  d^ripl^n  of  the  muitibody  system.  For  example, 
if  the  movement  of'a  muitibody  system  is  given  and  the  driving  forces  A*  in  the  joints 
are  required.  Dymola  generates  the  inverse  model.  On  the  other  hand,  if  the  generalized 
accelerations  q,'  have  to  be  calculated,  Dymola  generates  the  equations  of  motion  or  direct 
model.  For  such  a  task,  Dymola  instantiates  the  equations  for  every  involved  object  from 
the  dass  library, .adds  the  equations  for  the  object  connections,  and  sorts  all  equations 
in  such  a.  way  that  all  unknown  variables  are  calculated  from  the  known  variables.  For 
the  inverse  model  it  turns  out  that  this  strategy  will  generate  equations  to  calculate  the 
unknown  Joint  forces  in  exactly  the  same  way  as  the  0(n}  algorithm^  of  Luh/Waiker/Paul 
(ISj.  The  generated  code  >s  therefore  very  ^dent. 

In  the  case  of  the  e^uafions  of  motion,  several  practical  problems  appear  when  calculating 
the  generaiued  accelerations  of  the  system.  First  of  all.  the  user  has  to  select  minimal 
coordinates,  which  may  not  be  a  triwal  task  if  the  system  contains  closed  kinematic  loops. 
Secondly.  Dymola  wilS  detect  a  very  large  (sparse)  system  of  equations  that  could  be  solved 
as  a  general  system  of  Index  1  differential>algebraic  equations  (DAE).  However,  since  this 
system  of  equations  is  huge  even  for  modestly*«zed  muitibody  systems,  standard  general* 
purpose  CAE  solvers  such  as  DASSL  [23)  are  not  applicable.  If  only  joint  coordinates  q,  are 
used  as  minimal  coordinates  and  if  the  muitibody  system  has  no  closed  kinematic  loops, 
the  large  system  of  equations  is  linear.  Dymola  can  solve  linear  equations  symbolically  m 

V'  number  of  degrees  of  freedom 
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Figure  6:  Exjmple  of  mullibody  system  modeling  using  Dymols 


order  to  rrduce  the  OAE  to  stite  spsce  form.  SeversI  examples  have  Indicated  that  the 
standard  built-in  method  of  Dymola  to  solve  this  matrix  equation  will  usually  produce  very 
inefficient  code.  With  special  taring  mechanisms,  it  is  possible  to  make  the  solution  of 
the  matrix  equation  more  efficient.  While  Dymola  supports  tearing,  an  application  of  this 
technique  requires  some  user  interaction 

In  the  next  section,  an  alternative  approach  is  explained.  For  the  direct  pnbltm,  a  second 
class  library  called  mbsdir.lib  is  provio  id,  which  has  essentially  the  same  interfaces  as  the 
class  library  misinu.fii  explained  above.  A  multibody  system  is  defined  in  eactlg  the 
same  way  at  before.  However,  the  equations  of  the  clast-library  mbsmv.hb  have  been 
tranrformed  in  such  a  way  that  Dymola  will  produce  very  efficient  code  for  tree-structured 
roultibody  systems  with  variable  structure. 


4  Adaptation  of  class  library  to  direct  problem 

Equations  (1)  form  the  starting  point  to  reformulate  the  class  library.  The  reformulation 
IS  based  on  the  assumption  that  it  is  always  possible  to  express  the  force  and  torque  f,. 
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v^hich.is  transferred  between  the  cuts  of  multibody  objects,  as  a  linear  function  of  the 
ab^Iute  linear  and  angular  acceleration  a,'  transferred  via  the  same  cut,  i.e., 

f,  =  I.a.  +  b.  ;  I,=I?'  (6) 

This  assumption  holds'  true  for  ciaues  £ody  and  force  since  the  corresponding  equation 
(4)  of  a  body  object  is  already  in  this  form,  and  since  the  equation  for  a  force  object  is 
a  special  case  with  I,*  =  0  because  a'force  law  does  not  depend  on  accelerations.  What 
remains  to  be  shown  is  that  thU  assumption  also  holds  for  class  Fnmt.  For  the  proof  of 
this  statement,  assume  first  that  equation  (6)  holds  true  for  cut  6  of  an  object  of  class 
Frame.  According  to  Wehage  (27|,  equations  (Id.lf.lg)  together  with  equation  (6)  can 
be  combined  to  form  the  following  linear,  symmetnc  matrix  equation: 


■  I.  -E  0  O' 

*1  ' 

-b, 

-E  0  0 

f. 

-c,«,  - 

0  0  -1, 

q. 

a: 

0  0  -L.  L,  -  E  , 

Ia;J 

0 

Equation  (7)  states  that  the  unknown  variables  of  frame  t  can  be  expressed  as  Imtar 
fuf'ctions  of  the  unknown  acceleration  a,  of  frame  r.  Solving  (7)  explicitly  for  the  unknown 
quantities  of  frame  t  results  in: 


a! 

= 

(8») 

q. 

=  Mr‘(h.  +  A!) 

(8b) 

«. 

=  C,ar  +  #iq. +  ^, 

(8c) 

fi 

=  l,at  +  b| 

(8d) 

where 

t.  =  X^-*J{UCX  +  (,)  +  b,)  (9») 

M.  =  (ffl.#,  (9b) 

L:  =  (L.Mr'  +  E  -  L,)''  L.M,-'  =  L.  1/  =  1x1  (9c) 

Inserting  these  equations  into  (le)  yields  the  transformed  force  f^(,)  as  a  function  of  the 
acceleration  of  frame  r: 

f,(i)  =  E(,)a,  +  b,(.)  :  I,(,)  =  If,,,  (10) 

where 

I,(,)  =  CfN.C,  (lU) 

b,(,)  =  C?'(b.  +  N.«,  +  I.if,Mr'(B-I,:)(Af-#?'b.))  (11b) 

N,  =  I,  -  I,#,Mr‘(E  -  L:)#ri.  (11c) 

M,  =  (lid) 


L:  =  (L,M.-' +  E  -  L.)"' =  L.  i/d.m(L,)  =  lxl  (He) 


,lt  has  thus  been  proven<that,(6)  implies  (10).  The  fact  that  forces  at  a’connection  node 
sum  to  zero.jhat  accelerations  are  identical  and  that  h  and  are  declared  as  through 
variables  irnplies  that  (6)  holds.  Q.E.O. 

Thr.  class  library  mhsdir.lib  is  built  by  using  the  already  explained  class  library  mbsinv.hb 
and  by  fepladng  equations  (Id-lg)  by  equaVioM  (8-11).  Furthermore,  not  the  torque  and 
force‘f,^is  propagated  through  cuts,  but  the  linear,  favors  li,  b,*  of  the  torque  and  force  in 
accordancc'wtH  (6,10)?  ^ 

The  main  advantage  of  this  reformulation  lies  in  the  fact  that  Dymola  can.sort  the  equa> 
tions^of  a  tree  structured  multibody  system  ex^iatly  for  the  generalized  accelerations 
q,-  without  encountering  algebraic  loops  (with  the  exception  of  small  linear  systems  of 
equations  within  frame  objects,  which  are  solved  by  inverting  matrix  Mr  of  (lid)).  This 
property  can  be  explained  as  follows:  The  linear  factors  I,,b,  are  known  at  Body-  and 
fo^c^objects.  Usingequations(lla.Ub),  these  factors  are  propagated  through  all  from^ 
objects  finally  arriving  at  the  inertial  system.  Since  the  acceleration  of  the  inertial  system 
is  known,  equations  (8)  can  be  used  to  calculate  all  unknown  variables  of  the  objects  that 
are  directly  attached  to  the  inertial  frame.  Afterwards  the  accelerations  of  these  objects 
are  known,  and  therefore  the  unknown  variables  of  all  objects  attached  to  them  can  be 
calculated,  and  so  on.  Of  course,  this  feature  is  only  valid  for  tree>structured  multibody 
systems. 

The  number  of  operations  in  the  generated  code  is  proportional  to  the  number  of  degrees 
of  freedom  (s  0(rt))  of  the  multibody  system  and  is  therefore  very  efficient,  especially 
if  n  is  high.  In  the  same  sense  as  the  inverse  problem  solution  with  library  mbsxnvM 
is  equivalent  to  the  Luh/Walker/Paul  algorithm  (15|.  the  direct  problem  solution  with 
library  m6sdtr./ti  is  equivalent  to  the  recursive  0(n)  algorithm  of  Brandl/Johanni/Otter 
|1|.  Note  that  these  two  algorithms  are  not  explicitly  programmed.  Instead,  only  local 
properties  of  objects  are  stored  in  the  corresponding  dau  libraries.  Due  tc  the  builton 
connection  rules  of  Dymola  together  with  its  sorting  algorithm,  Dymola  ‘'reinvents*'  these 
algorithms  on  its  own. 


Variable  structure  systems 

The  above  class  library  extends  the  recursive  algorithms  such  as  |1)  in  one  important 
aspect,  it  allows  the  handling  of  variable  structure  systems.  As  already  noted,  matrix 
L,  signals  whether  a  degree  of  freedom  of  a  joint  a  locked  or  not.  As  can  be  seen.  L, 
appears  in  some  places  in  the  recursive  relations  (11).  The  occurrences  of  matrix  L,  can 
easily  be  interpreted:  Assume  that  alt  degrees^f*fre^om  of  a  joint  are  free,  i.e .  L,  s  0. 
and  therefore  L*  =  0.  In  this  case.  (11)  are  the  usual  recursive  relations  Or:  the  other 
hand,  if  all  degrees*of*freedom  are  locked.  Lj  =  E  and  therefore  L*  =  E.  and  iquations 
(11)  reduce  to  the  recursive  relations  of  a  fixed  jdnt  with  zero  degrees  of  freedom  The 
generated  equations  are  nearly  as  efficient  as  if  matrix  L,  were  not  present.  This  can 
easily  be  seen  for  a  joint  with  one  degree  of  freedom.  In  this  case,  matrices  M,  and  L. 


are;scaiars,  and'.onIy,.tvyo  multipii^tions.  one  subtractton  and  one  addition  are  added  in 
order  to  calculate  M,”^(E  -  L*),  -L^h.^h,  +  X\,  i.e..  the  efficiency  reduction  due  to  the 
variable  structure  is  negligible. 

the  variable, structure  of  a  multibody  system  may  be  caused  by  a  brake,  by  a  stop,  or  by 
sticking  friction,  in  the  latter  case,  an  additional  problem  appears  since  the  sliding  friction 
force  is  usually  a  function  of  the  constraint  forces  in  the  joint.  If  this  function  is  linear  in 
the  constraint  forces,  it  is  possible  to  generalize  the  above  equations  without  destroying 
the  recursive  0(n)  nature. 

The  force  and  torque  f,  acting  on  frame  t  can  explicitly  be  expressed  as  a  function  of 
the  known  applied  forces  Af  and  the  unknown  constraint  forces  Af  in  a  form  proposed  by 
Roberson  and  Schwertassek  (25|: 

f,  =  sPf(A*  +  L.A;)  +  lPfAf  (12) 

Matrices  are  defined  such  that  the  following  relations  hold 

=  0  (13) 

If  the  joint  is  in  sliding  mode,  the  friction  forces  A*  are  linear  functions  of  the  constraint 
forces  Af.  t.e., 

AJ  =  (E-.Li)/i.Af  iU) 

Inserting  equation  (14)  into  equation  (12)  yields: 

f.alPfCL.AD  +  lf.'A;  (15) 

where 

^';  =  !Pf+ip:(E-t.)fi, 

In  a  second  step,  a  matrix  has  to  be  determined,  which  lies  in  the  nulhspace  of 
i.e.. 

(16) 

Finally,  equation  (If)  has  to  be  replaced  by  (15,16).  As  before,  the  recursive  relations  are 
derived  from  a  linear  system  of  equations,  which  is  equivalent  to  (7); 


I.  -E  0  0 

’  a, 

-b, 

-E  0  0 

f. 

-C,a.  - 

0  i>f  0 

q. 

0 

,  0  0  -L.  1,,-E 

Ia;J 

0 

Equation  (17)  has  nearly  the  same  structure  as  (7)  with  the  major  difference  that 
is  replaced  by  matrix  As  a  consequence,  the  system  matrix  of  (17)  is  no  longer 
symmetric  Hence,  the  linear  factors  I,  of  the  forces  f,  are  no  longer  symmetric  either 
Except  for  this  property,  the  derivation  proceeds  as  before,  and  the  resulting  equations 
are  identical  v.ith  the  previous  equations  with  the  deviation  that  is  replaced  by 
everywhere 


,5  .Pymqla  ;model  of<inechanical  part  of  robot 


The  Oymola  library  for  multibody  systems  as  ^pla'med  in  the  last  two  sectioti*  is  not 
provided  here  due  to  space  limitations:  However,  to  demonstrate  its  usage,  the  multibody 
mode!  of, the  6  dof  robot  of  section  2  is  presented: 

'model  eUss  Admli 

submodel  (htrttal)  t(nfSs.l) 

*vhmo6€\(Revitute)  rl(nSsJ)t  r3(nlsJ,rSs0.5), ... 

submodel  (Bodf)  hl(lS$sL16) 

submodel  (Body)  ht(msS6.S,  rJaff.nt,  rSsO.m, 

IllsUS,  ISSsO.Sd,  lSt=>0.46) 

submodel  (Bedj)  iMd(m=0,  rl=0,  rS=0, 111=0,  JSS-0,  1SS=0,  IS1=0) 

cut ;/  (^1,  idl,  iddl  /  it)  (aogle,  sagulsr  velocuy, 

sngulu  eccci^stioD  /  torque  in  joint) 

cut  )i  (^i,  ^di.  ^ddS  /  iij 

cut  j6  ffd,  fdd,  idd6  /  iS) 

couaect  i  to  r/  to  ti  to  f3  to  td  to  rd  to  t$, 

kl  at  fJ,  kt  at  rd,  h$  at  r$,  id  ot  rd»  dd  at  rS,  h«d  at  rd, 
jl  at  rl:Atu,  jiat  /dat  rS:AtUf 

at  r^Mns.  ;dat  rdMtts,  ;dat  rO:Att$ 

{body  6  without  load  is  neglected  with  respect  to  rotor  of  body  6) 

end 


To  define  the  robot,  it  is  positioned  in  a  special  configuration  (here:  "vertical  position" 
of  all  bodies).  All  vectors  and  tensors  are  given  in  this  configuration,  resolved  in  the 
inertial  frame.  A  revolute  joint  is  for  example  defined  by  the  position  vector  r,  from 
the  reference  frame  r  to  frame  i  of  the  joint  and  the  axis  of  rotation  n.  All  coordinates 
of  these  VKtors  are  zero  by  default.  Therefore  the  declaration  "submodel  (Rtvolutt) 
rS(nlssl,r3=0.Sr  defines  a  revolute  joint,  which  is  located  0.5m  in  the  direction  of  the 
3«axis  of  frame  r2  (due  to  "connect  rf  to  r^”)  and  which  rotates  about  axis  1  of  the 
new  frame  r3.  When  the  axes  of  frames  r2  and  r3  coincide,  the  rotation  angle  is  zero. 
The  other  muitibody  objects  are  defined  in  a  similiar  fashion.  The  interface  of  the  robot 
to  the  outside  world  is  given  by  cuts  jl,  idi.  which  transfer  the  angle,  the  angular 
velocity,  the  angular  acceleration  and  the  torque  in  the  revolute  joints. 

Generating  the  equations  of  motion  and  the  inverse  model  for  an  object  of  the  above 
class  (i.e..  the  multibody  part  of  the  robot  only),  Dymola  produces  code  for  each  of  these 
problems  within  about  10  seconds*  containing  the  following  operational  counts. 

*on  in  Apollo  wofkstition  with  i  Motorola  68040  proetuor 


10$ 


*,/  operations 
4*,  -  operations 


727  j  269 

493  j  190 

The  numbers  of  operations  are  approximately  the  same  as  for  other  symbolic  muitibody 
programs. 


6  Conclusions 

In  this  paper,  a  new  library  for  the  object-oriented  modeling  language  Oymola  was  presen¬ 
ted  that  supports  the  modeling  of  general  multibody  systems  consisting  of  j  connection  of 
rigid  bodies,  ideal  joints,  and  force  elements.  The  presented  library  generates  efficient  code 
for  tree-structured  multibody  systems.  Multibody  systems  with  closed  kinematic  loops, 
such  as ;  five-point  wheel  suspension  system  with  four  closely  coupled  loops  and  one  dof. 
have  also  been  studied  already,  but  the  treatment  of  such  systems  is  not  yet  sufficiently 
comfortable  due  to  required  user  interaction.  This  situation  will  improve  soon. 

Oymola  must  not  be  viewed  as  just  'yc^  another"  multibody  program.  The  unique  fea¬ 
ture  of  Oymola  is  its  support  for  modeling  components  from  several  different  engineering 
disciplines  within  one  environment.  For  example,  Oymola  has  been  successfully  applied  to 
the  modeling  of  the  thermodynamic  behavior  of  a  house  using  bond  graphs  f26|,  cnemieal 
reaction  systems  (2),  and  electronic  circuits.  Presently,  Oymola  is  enhanced  by  sophistica¬ 
ted  new  language  elements  for  the  definition  and  handling  of  discrete-event  systems  based 
on  time  and  state  events  (5|.  This  will  also  add  new  functionality  to  the  multibody  libr¬ 
ary.  since  sampled  data  systems,  interconnected  friction  elements  and  other  discontinuous 
elements  can  be  handled  easily  by  use  of  these  language  extensions. 
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MINIMAL  DYNAMIC  CHARACTERIZATION 
OETREE-LnCE  MULTIBODYjSYSTEMS 


P.  FISETTE,  B.  RAUCENT  AND  J.C.  SAMIN 
(JfdvtrnU  Cathalique  di  Louvain 
Dipanemeru  do  Micanique 

2,  Ptoeo  duUvant  8-1348  Lowatn-la  -Ntuvt,  Bel f  turn 


ABSTR^^CT.  ITie  <{ynAmlc  model  of  tree<Uke  mulubody  systems  is  Imear  with  respect  to  the  parameien 
c(  mm  J'stnbuoon  for  InstiAce  when  btrycentnc  penn^ten  are  used.  Thus,  assuminf  that  the  parameters 
related  to  the  IdAetnaocs  are  perfectly  lcf\own.  these  quanddes  can  be  estunaied  throuih  linear  refiession 
techniques.  lU  necessary  data  are  obtained  by  measuring  the  jouit  forces  and/or  torques  and  the  resulong 
niooon  given  in  terms  of  posidors,  velocities  and  acceleradcns.  An  altemaave  method  uses  measaremenu 
of  ihe  leacaon  forces  and  torques  applied  to  the  bedplate. 

The  Uoearity  of  the  dynamic  arid  reaction  models  with  respect  to  the  barycenmc  quantities  does  not 
however  imply  that  the  latter  rortstitute  the  minimum  set  of  parameters  characterising  the  mass 
distnbudon  of  the  system.  In  other.wotds,  some  bvycentnc  parameters  may  disappear  from  the  models  or 
may  be  redundant  in  the  sense  that  they  appear  only  via  linw  combinations.  In  the  first  case  they  are  not 
ident^le,  while  in  the  second  case  the  linear  regr^on  technique  leads  to  estimated  values  which  are 
correct  for  the  combinations  but  can  be  enoneow  for  the  individual  parameters. 

The  various  options  taken  to  denve  die  dynamic  and  reaction  models  by  use  of  the  ROBOTRAN 
programme  are  briefly  reviewed.  Then  the  rules  leading  to  the  mmunal  parameffu.uon  are  presented  and 
illustrated  by  means  of  a  practical  example  related  to  a  robot  c^iibrat)on  problem. 


Intitiduction 

Vanous  problem  in  robotics  require  the  computation  of  the  dynamical  model  of  the  robot 
which  relates  the  generalized  control  forces  that  are  transmitted  through  the  joints  and  the 
corresponding  generalized  coo^lnates  qj.  their  velocities  and  accelerations.  For  instance 
high  speed  and  high  precision  control  can  only  be  achieved  using  advanced  control 
algorithms,  such  as  the  'computed  torque*  control,  which  require  an  accurate  and  in-depth 
knowledge  of  the  robot  dyn^ics. 

The  structure  itself  of  the  dynamical  equations  is  well  known.  However  these  equations 
contain  parameters  which  correspond  to  the  physical  characteristics  of  the  various  bodies 
consutuung  the  robot  and  therefore,  a  good  knowledge  of  these  parameters  is  absolutely 
necessary.  In  particular,  measunng  the  parameters  related  to  the  mass  distribution  is  not 
invial  and  leads  naturally  to  an  identification  problem  (1Z3.4). 

In  the  first  section  of  this  paper,  it  is  shown  •  often  noted  "a  posterion*  as  a  fact  (4)  •  that 
the  dynamical  model  is  linear  with  respect  to  the  parameters  of  mass  distnbmion  if 


baiyccnmc  quan'iues  are  used  (5).  However,  it  should  be  noted  that  this  Imeanty  with  respect 
to  these  untoo  vn  paramerers  is  valid  only  if  the  geometneal  lengths  oi  the  system  are 
supposed  to  be  icnown,  for  instance  by  a  kinematic  calibration  (6). 

In  order  to  emphasiae  these  properues.  the  equauens  of  motion  of  a  tree-like  muUibody 
system  have  been  written  in  a  particular  vectorial  form  derived  from  the  Potential.  Power 
i^ciple  (a  modined  version  of  d'Alembert  Principle)'  As  presented  in  section  two.  this  form 
is  used  by  ue  piogramme  ROBOTRAN  (7)  to  provide  automaticaily  the  dynamical  model. 
ROBOTRf.N  deals  with  mathematical  eapressions  by  means  of  pointers  (PASCAL 
programmi'ig  Pinguage)  and  prints  the  resulting  equations  in  a  literal  form  (character 
strings).  One  purpose  of  this  programme  is  to  emphasize  the  linearity  with  respect  to 
barycentti':  parameters,  so  the  derived  equations  are  not  necessaiily  optimal  as  regards  the 
number  o '  anthmeiic  operations  for  numerical  simulations. 

In  the  third  section  of  this  paper,  an  original  procedure  for  the  estimation  of  the 
barycentric  parameters  of  a  robot  is  presented  (8.  9,  10).  This  procedure  is  based  on  the 
property  that  the  relations  between  the  robot  motion  and  its  reacnoiis  on  the  bedplate  are 
completely  independent  of  the  internal  joints  forces.  The  procedure  thus  requires  only  the 
processing  of  measurements  provided  by  an  catcmal  experimental  set-up  (8)  The  robot  is 
placed  on  a  sensing  platform  which  Is  provided  with  sensors  able  to  measure  the  three 
components  of  the  forces  and  the  three  components  of  the  torques  between  the  bedplate  and 
the  fltst  link  of  the  robot 

Section  four  deals  with  the  parameter  combinations  which  are  required  to  satisfy  the 
idendfiabiUly  conditions.  A  systemadc  way  to  obtain  these  combinations  is  presented.  In 
panlcular.  it  is  shown  that  the  reacdon  model  used  for  Idennficadon  has  the  same  smiciure  as 
the  dynamical  model  and  that  all  the  barycentric  parameters  occuring  in  the  dynamical 
model  also  appear  explicitly  in  the  Idendflcadon  model.  Finally,  a  practical  exempie  of 
parameter  comhlnadon  is  given  in  the  fifth  secdon. 


1,  Dynamic  and  tdentifleation  Models 


1.1.  GEOMETRICAL  STRUCTJRE  AND  KINEMATICS 


In  this  secuon,  we  will  review  the  vanous  opnons  taken  to  desenbe  the  mulubody  systems 
under  consideration. 

The  system  is  considered  as  a  set  of  n  rigid  bodies  mterconnected  by  joints.  In  the  present 
paper,  it  is  assumed  that  the  structure  is  a  topological  tree.  The  joints  are  numbered  in 
ascending  order,  starting  from  the  base-plate  (b^y  0)  and  each  body  has  the  same  index  as 
the  precedmg  joint.  A  function,  INBOOY,  is  then  defined  to  provide  for  every  joint  the  index 
number  of  the  preceding  body.  By  means  of  a  recurrent  use  of  this  function,  the  whole  set  of 
indices  of  bodies  and  jomis  of  the  kincmaocal  chain  which  connect  an  arbitrary  body  to  the 
base  can  be  obtained.  The  notation  i  £  j  means  that  the  joint  (body)  i  belongs  to  this  chain 
for  body  j.  For  later  convenience,  a  boolean  matrix  T  is  used  whose  elements  are  defined  as : 

(  I  if'Sj 

T'l.j  (I) 

1  0  otherwise 

The  chaiactensnc  geometneal  dimensions  of  a  body  i  (see  fig  1)  are  given  by  the  vectors 
1,'J  and  I,''.  Two  indices  are  needed  because  of  the  tree  structure  However,  although  such 


vectors  should  be  defined  only,  for.  consecutive  bodies,  the  notation  is  extended  to  all  the 
indices  k  sadsfying  t  <  k.  defin^g  |,^as  follows  :• 

n  pj  for  V  k  such  that  i  <  j  S  k  (2) 

Thus  defined.  provides  the  contribution  of  body  i  to  the  kinematic^  chain  leading 
from  the  base  to  bc^y  k.  Since, the  bodies  are  supposed  to  be  rigid,  all  the  vectors  Ml  have 

A. 

coiuunt  components  if  they  an  expressed  in  a  frame  (X')  attached  to  body  I. 


The  joints  are  restricted  to  one  degree  of  freedom  :  revoluie  or  pnsmaiic.  There  is  no  ioss 
of  generality  since  any  physical  joins  can  be  modelled  as  a  succession  of  such  elementary 
joinci.  In  order  to  develop  the  Unemitlcs.  we  thus  consider  that  each  joint  allows ; 

•  a  relative  rotadon  expressed  by  the  totadon  matrix  aJ  that  relates  the  body  fiame  |;cJ| 
to  the  previous  one  (xl).  This  matrix  Is  constant  for  prismatic  joints  and  depends  on  the 
angular  cooidinate  qi  in  the  case  of  revoluie  jointt. 

•  a  reladve  tnnsUtlon  represented  by  the  vector  li.  This  vector  Is  equal  to  reto  for  revoluie 
joints  and  depends  on  the  translational  coordinate  ql  in  the  case  of  prismadc  joints. 

The  previous  derinidons  are  quite 
general  and  sdU  allow  us  to  choose 
die  orientations  of  the  body  fnmes 
(xi)  as  welt  as  the  locanons  O'  of 

their  ongins  (fig.  I)  in  order  to 
minimize  the  number  of  geometric 
parameters  such  as  for  instance  by 
using  the  Denavii  and  Haitenberg 
convendons.  An  equivalent  minunal 
kinematic  desenpdon  (suggested  in 
(ill)  is  lUusliaied  in  fig.  2  in  the 
case  of  a  serial  link  stiucture. 
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1.2.  .Mass  distribution  para-meters  and  dynamics 

The  dynamics  of  ihe  system  depend  on  the  mass  distnbuPon  of  each  body.  The  related 
parameters  could  be  considered  individually  for  each  body,  but  some  of  these  parameters 
would  then  combine  to  provide  the  actual  parameters  in  the  dynamic  equations.  These 
combinadons  co'uid  be  ^rformed  manually  (4)  but  this  effort  can  be  avoided  if  appropnaie 
cbmbinadons.aro  introduccd  from  the  outset  by  considenng  the  position  of  the  bodies  m  the 
topological  sttuctuie  (121. 

Denoting  by  m'  the  mass  of  the  i'*'  body,  by  i“  the  position  vector  of  its  centre  of  mass  G' 
with  respect  to  O'  (fig.  3)  and  by  I*  its  inenia  tensor  with  respect  to  O',  the  following 
(barycentnel  parametets  are  mtroduced  ; 


m*  =  T  T'k  mit 

(3) 

k 

mb'  .  T  ink  mit  liit 

(4) 

k 

K'  •  I'  •  5]  rk  mk  [ik  p 

(5) 

It  »  I 

where  i  denotes  the  skew-symmemc  tensor  associated  with  the  cross  product  by  a  veaor  s 
These  pirametcis  are  uidependent  linear  combinations  of  the  basic  mass  paramcit'is  mli. 
njkl^kk  and  Moreover,  according  to  the  previous  definitions.  S''  Is  constant  ind  the 
moments  of  order  1  (inb')  and  order  2  (K*)  have  constant  components  when  expressed  m  the 

A 

frame  (X>).  These  buycentric  quantities  may  therefore  be  chosen  as  constant  parameters 

which  fully  desenbe  (he  mass  disihbution  of  the  muliibody  system.  Since  there  are  10  such 
scalar  quantities  for  each  body  in  the  system,  the  loiri  set  of  b^centric  parameters  is  lOn. 


From  a  physical  point  of  view,  the  mass  m*  repmsents  the  mass  of  an  augmented  body  t 
which  consists  of  body  i  and  point  masses  rnJ  (with  i  -  INBODYO))  located  by  the  veaor 
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The  vector  rnb*  is  the  moment  vector  locsung  the  mass  centre  of  this  augmented  body  and 
the  tensor  K'  is  its  inertia  tensor  with  respect  to  ns  attachment  point  O'. 

As  shown  in  (5|  the  Principie  of  Potential  Power  for  rigid  body  systems  ieads  to  the 
foUowing  vector  dynamic  equations : 


p  =  ml(  +  +  'j) 

k;lc<j 

+  T  Tl''  (  nfl'i''  Skgic)  inijlc)  (5) 


T)'‘(j,kaFktinb'‘x(|>'-|)  + 
k 

+  2  S  ni.bk*(|l  +  (§l  +  glgl)ilk) 

k  lil<k 

+  2^  TJ'‘  5^  X  +  (5*  +  gig')  qtbl)  (7) 

_ k  Ikel _ 


and  two  impoitant  piopeiiles  which  are  often  noted  *a  posteriori'  as  a  fan  (4),  arise  t 

I)  Iht  torques  y  ond  the  forcts  gi  are  //near  faitctioiu  of  the  baiycentric  parameters  m*. 
inbi'.  (fl*  with  k  such  that  J  Sk.  They  become  bUbtear  if  the  geometric  lengths  yl'  (J<k)  are 
also  considered  as  parameters. 

II)  the  definition  of  TJlr  given  in  (1)  allows  us  to  observe  that  L*  and  J*.  wit*  i  »  INBODTIJ). 
contains  all  the  terms  Included  In  y  and  FJ,  and  therefore  the  same  barycentrte  parameters 
lln  addition  to  those  related  to  the  augmented  body  1). 

in  order  to  obtain  the  scalar  equations  of  the  dynamic  model,  we  need  to  project  the 
vectors  y  (or  FI)  onto  the  axis  of  its  cotiesponding  levolute  (or  pnsmatic)  joint.  Then  all  the 
pioducis  (scalar,  vector,  tensor)  must  be  peifonned  to  obtain  the  final  form  of  the  dynamic 
model  in  which  the  generalized  coordinates  q',  velocities  q'  and  accelerations  q'  appear 
explicitly.  The  latter  can  be  wntien  unuer  the  following  matrix  form  : 

M(q,9)q  +  F(q.4,e)  ■>  Q  (8) 

where :  .M  is  the  (nxn)  posmve  definite  symmetric  inenia  matrix  of  the  system,  F  is  the  n- 
vecior  specifying  gravitation,  Coriolis  and  centrifugal  effects,  Q  is  the  n-vector  of  the 
generalized  forces  associated  with  q,  and  8  is  the  lOn-vector  containing  the  baiycentnc 
parameiets 

Although  the  above  operauons  preserve  the  linearity  of  the  model  with  respect  to  the 
components  of  the  batycentnc  parameters,  the  dynamic  model  involves  a  few  independent 
combinations  of  those  baiycentnc  parameters.  These  combinations  depend  on  the  paracular 
nature  (either  pnsmatic  or  revolute)  of  the  joints  and  recu.’slve  methods  for  obtainmg  them 


m  a  sysiemancal  way  wiU  be  descnbed  in  secaon  4.  They  lead  lo  a  sci  of  Nd  combined 
parameters  denoted  5d ' 

6d  »  Sd6,  ('9) 

where  Sd  is  a  full  rtng  matnx.  EquaUon  (23)  can  therefon;  be  rewnnen  in  the  linear  form 

0d(q.4q)Sd  =Q.  (10) 

where  Od  *  regressor  vector  depending  on  joint  posiUoa^.  velocities  and  acceleraoons 


2.  Oesaiptlon  of  (he  Robotran  software 

The  main  purpose  of  ROBOTRAN  {7}  is  to  provide  a  literal  express'  .n  (characiei  stnngs)  of 
the  dynamic  mcdel  of  any  muldody  system  By  using  the  opuon  dedicated  to  idenuficanon. 
the  barycencrie  paiameten  appear  explicitly  in  these  expressions!  so  that  the  user  can  easily 
regroup  their  coefficients  in  order  to  (^tain  the  regression  vectors  $d- 

2,1.  THE  PROGRAMME  SYNTAX 

Each  mathematical  expression  oi  equation  (10)  contains  one  or  several  terms  linked  by 
minus  or  plus  signs,  each  term  b  ing  the  p^uct  of  several  factors.  A  factor  can  be  an 
integer,  a  barycenmc  parameter,  a  generalized  coordinate  (qj,  qi>  qi)>  4  geometnea)  constant 
a  trigonomeolcal  function  whose  argument  is  a  factor,  or  a  mathemaocal  expression  between 
brackets.  Thus  defined,  an  expression  uan  be  considered  as  a  tree  whose  nodes  represent  the 
nanue  of  the  expressions : 

•  integer  whose  value  has  to  be  given  as  a  constant 

•  barycentric  parameter,  generalized  coordinate  or  geomeuical  constant  which  have  to  be 
idenoned  by  an  appropriate  string  of  characten. 

•  cosine  or  sine  function  whose  argument  (also  an  expression)  must  be  given. 

•  plus,  minus,  tunes  operators  whose  two  operands  must  be  given  as  expressions. 

For  instance,  the  expression  (g  *  sin(qi)  q2)  can  be  represented  by  ilg  4  : 


Fig.  4  ;  Tree  representation  of  a  symbolical  expression. 


!  These  expressaocu  are  thus  oo.  necessarily  opumal  as  regards  (he  nisnber  of  anthmetze  openuons  for  on* 
line  appheanons. 


2.2.  tHE  MAMPULATIONS  AND  SlMPLinCATlONS 

In  order  to  avoid  expressions  like  '  x  =  a  b  •  a,  some  order  is  introduced  to  classify  the 
expressions. rthis  order  is  given  first  by  their  narures  and  iHen  by  a  lexicographical  order  on 
the  stnngs  of  characters  (for  instance,  0  <  cbs(qi)  <  sm(qi)  <  (q2-«'q3))>  At  each  operation, 
tfie  re^dng  expressions  are  rewniten  according  to  the  presented  order  and  then  consecunve 
equal, t^s. with  opposite  sii^s  are  simplifled.>It  can  thus  be  ensured  that  the  expression 
appearing- in  the; obtained  equations  canrro*  be  fbnher  reduced  without  using  specific 
formiilae'pf  trigonometry. , This  kind  of  reductions  can  be  perfonned  manually  or  by  several 
dedicated  programmes  (MACSYMA.  SMP,  REDUCE. ...). 

Finally,  in  order  to  reduce  the  size  of  the  output,  intermediate  auxiliary  vanables  can  be 
used  to  replace  each  product  of  tngbnomerncal  functions.  These  vanables  are  produced  by 
taking  the  relation  order  into  account  so  it  is  as  easy  as  before  to  find  the  possible 
combinations  of  barycentric  parameten  and  the  regression  vectors. 

2.3.  APPLICATION  TO  THE  PUMA  ROBOT 

The  PUMA  i62  (UNIMATION^)  is  a  serial  six  degree  of  freedom  manipulator  with  revolute 
joints  (fig.  5).  Assuming  here  that  the  influence  of  the  wnst  is  negligible,  only  the  first  three 
joints  are  considered. 


Fig.  5  :  The  PUMA  562  (UNIMATION®). 

Three  body*flxed  frames  have  been  inuoduced  for  the  dynamic  modelling.  In  the 
reference  configuration,  when  the  wnst  is  locked  straight  above  the  shoulder,  all  these  frames 
are  aligned  with  the  inertial  frame  (X^|  attached  to  (he  bedplate.  The  physical  charactenstics 
(geometry  and  mass  distnbuiion)  of  each  body  are  given  in  table  1. 


Central  Inertia  Tensor 


Center  of  mass  position 
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0 
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■H 

Table  \ :  PUMA  Descnpdon 


According  to  t^e  sjmbols  deflned  in  this  table,  the  bafycenine  parameteis  and  the  dynamic 
model  are  obtained  automatically  by  the  software  ROBOTTtAN ; 


mml «  ml+fn2+m3 
rTun2  a  m2'fm3 
mmi  ■  m3 

BafYwnmcniiQmcntt^ 

mblyaUty*ml 

mbU  ■  mm2«U2a«inz«mt 

mb2y  •  122y*m2 

mb2z  s  mm3*t23z*l22z«(n2 

mb3yal33y'*ra3 

mb3z  ■  I33z<m3 

Q3«  K3yz*qppl*C23 
+K3yy*<ipp2 
♦mb3z*qpp2*l23z*C3 
♦K3yy«dpp3 

•K3u*qpl*qpl*C23*S23 

♦K32Z*qpl*<lpl'C23*S23 

•mb3i*qpl*<ipl»l23z*C23*S2 

*mb3z*dp2«qp2«t23z«S3 

mb3z*g*S23 


Barveentne  tensors 

Klw  ■  llui'Hnfn2«ll2z*ll22>ml*(‘U  Iy*II  )y*ll  lz»inz> 
Klyy  >  nyy^mnl2*U2z*ll2z4>Ulz*IUz*ml 
Klyza4Uy*Ulz*ml 
Klzz  ■  Jts>IUy*Uly«m! 

K2u  a  J2u>m(n3«123z*l23z*m2*(>l22y*l22y*I22z*l222) 

K2yy  •  32yy<»mtn3«l23z*123z«^l22z*l22z*m2 

K2yza.|22y«122a*m2 

K2aai2zz^l22y*i22y*m2 

K3u  a  33«-m3*M33y«03y'133z»l33z) 

K3yy  a  J3yy>l33z*l33z*m3 
K3yza.i33y»133z«m3 
K3zz  a  J3zz>D3y*l33y*m3 

Q2-Q3 

♦K2yz*qppl*C2 

'mb3y*qj)pl*!2'  »C2 

♦K2yy*qpp2 

'fmb3z*q{^2*l23z*C3 

•fmb3z*qpp3*l23z*C3 

•K2xx«qpl»qpl*a«S2 

♦K2zz*qpl*qpl*C2»S2 

•mb3z*dpl*qpl*}23z*C2*S23 

•ml^z*<S>2*qp2*l23z*S3 

'mb3z*(0>3*<:]p3  •  123  z*S3 

•mb3z«  2*4^2  •qp3*123z«S3 

'mb2z«g*52 


^  The  particular  values  given  m  table  1  lead  to  a  zero  value  for  mbix.  Kizy  and  Kixz  (with  i*  1 , 2  and  3) 
^where  for  instance,  qpl  stands  for  q(l).  qppl  for  q<l),  S2  for  SIH(q(2)).  C2  for  COS(q(2)).  S223  for 
SIN(q(2>+q(2)4q(3)).- 
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Ql  ■  Kl2Z*<ippl 

*K^*qppI*S2*S2 

♦Kizz*qppl*C2*C2 

'*-K3u«qppl«S23*S23 

*IGa*qpp>*C23*C23 

4^nib3z*2*qppl«Q3z*S2*S23 

+K2yz*qpp2*C2 

4'IGyz«(ipp2«C23 

•mb3y*qpp2*l23z«C2 

♦K3yi*qpp3*C23 


•K2yz*qp2*(V>2*S2 

•K3yz*qp2^2*S23 

■fmb3y^2»qp2*)23z*S2 

■t>K2xx*^l*qp2*S22 

•K222*qpl*qp2*S22 

>iC3xx*<]pl*qp2*S2233 

•K3zz*(g>l*<tp2*S2233 

■ftnb3z*2»qpl*iq^*i23z*S223 

•K3yz^3*«v3*S23 

+K3xx*i^i*qp3*S2233 

•K2zz*<ipl*qp3*S2233 

>mb3z*2*qpl*qp3»U3z»C23»S2 

<fC3yz*2*qp2*qp3*S23 


3.  Identification  of  OTnamic  Parameters 

In  the  classical  identification  approach  the  values  of  S<{  aie  estimated  from  input  data  (torques 
applied  to  (he  links)  and  output  dau  (positions,  velocities  and  accelerations  of  the  joints) 
provided  by  ’'internar  measurment  devices  located  Inside  the  arms  (see  e.g.(l.2.3}).  The 
model  relating  these^  input  and  output  variables  Is  desenbed  by  the  linear  equations  (10). 
therefore,  in  principle,  parameters  can  be  estimated  through  linear  regression  techniques. 
However,  there  is  a  major  drawback  In  the  practical  implemetuation  of  such  techniques : 
direct  measurements  of  torques  applied  to  the  links  are  tx>t  available,  so  that  torques  have  to 
be  evaluated  as  sums  of  torques  provided  by  the  actuaton  and  of  friction  torques  which  may 
be  relatively  large.  Two  problems  then  occur : 

a)  For  most  commercial  robots,  torques  provided  by  the  actuators  can  be  obtained  from 
inttrncl  measurements,  but  with  poor  accuracy.  Consider  for  instance  a  permanent  magnet 
d'C  motor  controlled  through  its  amiwure  voltage  or  current.  The  torque  can  be  estimated 
from  input  current  measurements  using  the  torque  constant  available  from  the 
manufacturer's  technical  data,  albeit  vith  uncertainties  up  to  10%  :  furthermore  the  value  of 
ilus  constant  can  change  over  the  robot  lifetime. 

0)  The  implememation  of  a  parameter  esiunauon  procedure  requires  an  accurate  model  of 
fncuon  effects  and  estimation  of  the  characteristic  parameten  of  the  friction.  It  means  that 
barycencric  parameters  and  friction  parameters  must  be  estimated  simultaneously,  based  on 
an  adequate  friction  model.  This  coupling  between  barycentric  and  friction  parameters  may 
degrade  the  accuracy  of  the  barycemne  parameter  estimates. 

An  alternative  approach  has  been  proposed  in  order  to  avoid  the  above  drawbacks 
(S.9.101.  It  is  based  on  a  reformulation  of  Cie  system  dynamics  relating  the  monon  of  the 
robot  to  the  reaction  forces  and  torques  on  its  bed(date.  The  robot  is  placed  on  a  sensing 
platfonn  equipped  with  sensors  providing  measurements  of  the  three  forces  and  the  three 
torques  components  between  the  bedplate  and  the  robot.  The  main  advantage  of  such  an 
expenmenial  set>up  is  that  it  supplies  the  estimation  algonihm  with  data  which  are  far  more 
accurate  than  the  data  which  could  be  obtained  from  classical  sensors  located  inside  the  robot 
arms  Furthermore,  the  reaction  model  is  independent  from  internal  effects  (i.c.  friccon) 
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^.’^^yucal  expressions  of  jiHe  reaction  mode)  can  oe  obuined  for  the  reaction  torque  and  , 

forc“  components  bn^'Ae^l>edp^;by  projecting  the  vectors  L*  and  Fl  (given  by  Eqs.  (6) 
and  <7) )  onto  the  axes  reference  frame  an^hed  to  the  bedplate.  As  a  result  of 

conclusion  (1.2Ji)TaU  Uie*S^Mmric  parameters  contained  in  the  vectorial  joint  equauons 
(6)  and  (7)  will  appcL'Jn%V.,an<I  Fl  and  therefore  m  the  reaction  model-which  contains  all 
(he  components  of  ihe»  wq  vectdn.  Moreover,  the  few  linear  comblnadons  SrOf  barycentnc 
parameters  which  will  apqev-.whert  projecting'  O  and  on  the  axes  of  the  bedplate  frame, 
contain,  the  set^qf  llMtf.corabinatibn.6di  which  occur  while  deducing  the  dynamical  model 
(8)  from  ns  vectbH^?brjn*(6«7)i,Inro_thef  worts,  the  combined  barycentnc  parameters  set  5<i 
defined  in  (9)  is  a  subset  of  the'Nr  parameters  6r  which  appear  independently  in  the  reaction 
model : 

6(i^S6r  with6r  »  SfQ  (U) 

The  reacuon  model  has  thus  the  form  :• 

♦r<q.q.q)5t=C!r,  (12) 

where  «r  IS  a  regressor  vector  depending  on  pint  positions,  velocities  and  accelerations  and 
where  the  Q.  vector  contains  the  six  components  of  foicc/iorque  reactions  between  the 
bedplate  and  the  roboL 

Assuming  that  the  geometric  paiameiers  are  peifectly  known  from  a  static  calibration  (6], 
the  barycentnc  parafflciens  can  be  eaiimaied  through  linear  regression  techniques  based  bn  ' 

the  dynamic  or  reaction  model.  Indeed  by  taking  measurements  of  Q(l),  q(t).  q(i)  and  q(i) 

for  different  values  li.tg . tM  of  time,  the  following  linear  regression  model  Is  obtained  either  '■ 

from  (10)  or  (12) : 

<D5"Z  (13)  j 

where  1  Z»  (q%i) . Q^(lM))^and  ^ 

‘t’  •(♦(<i(ii).  q(ii).q(ii)) . ♦(<i(tM).  4(tM).q(iM)))^-  | 

The  problem  of  the  identinabUlty  of  S  is  stated  as  follows :  does  there  exist  only  one  set  of  | 

values  of  5  satisfying  the  linear  regreasion  model  (13)  for  any  motion  ?  We  have  the  j 

following  tnvial  result : 

"J  is  IdtntiflMt  iff  there  enisa  a  trajectory  tf  the  robot  such  that  0  has  full  rank". 

Indeed  in  this  case : 

5  =  (<I>110)-‘<1)Tz  (H) 

In  order  co  satisfy  this  condition,  we  have  to  avoid  redundant  parametnzations  and  to 
select  sufficiently  nch  trajectonea. 

(a)  to  avoid  redundant  parameimanons  of  the  model  (15.16,17).  A  parameinzation  5  ts  said 
to  be  redundant  for  the  model,  if  there  exists  another  parameinzaDon  8*  of  dimension  N* 

With  N*  <  N .  a  full  rank  mamx  S  and  a  regressor  O*  such  that  along  any  trajectory  ‘ 

8*  =  S*5  and  Z  =  05  (15) 

In  such  a  case  it  is  clear  that  O  cannot  be  full  rank.  For  most  mechanical  structures,  the  hill  I 

set  of  barycentnc  parameters  is  redundant  for  the  dynamic  and  reacuon  models  | 
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(bi  to^  seUct  trajectories  which  are  sufficientty  rich  In  (131  Gaulhicr  descnbes  a  procedure 
for  automatic  generation  of. test  trajectories 'Which  guarantee  the  identifiabiUty  rank 
conditions  of^O  assuming-a  non-redundant'parametrization.'We  have  however  observed  in 
practical  experimcnis'iKai  an  empirical  selection  of  such  irajeeiories  is  fairly  easy  when 
condition. (a)  is  satisfied  (14]. 


4.  Minimal  Dynamic  P^ametrization 

4.1.  THE  RECURSIVE  MODEL 

In  this  sccUon  a  recursive  method  for  obuining  the  minimal  set  of  parameters  5  in  a 
sysiemaUc  way  wiU  be  developed.  Since  any  joint  mobility  is  restricted  to  one  degree  of 
freedom  (i.e.  revolute  or  prismatic),  the  two  models  depicted  in  fig.  6  and  fig.  7  will  be 
considered.  These  systems  are  composed  of  a  body  j  and  a  carrying  body  i  (with 
i»INBODY(j)).  Depending  on  the  kinematic  chain  which  links  body  i  to  the  base,  this 
carrying  body  may  have  up  to  six  degrees  of  freedom  witn  respect  to  inertial  space. 

AccoiOIng  to  section  1,  frames  (ii)  and  (iJ)  ue  attached  to  the  bodies  and  the  axis 
vector  of  the  joint  J  is  denoted  by  ji. 

4.2.  PRISMATIC  JOINT 

The  angular  velocity  of  the  carrying  body  I  is  represented  by  (o*  and  the  absolute  position  of 
0‘  Is  given  by  the  vector  :■ 


Fig,  6 :  Pnsmaac  *ouu  recursive  model. 


where;'  Fi  =  mJ(!^-g)'f  09) 

end  die  dynemic  equation  of  joint  j  is  given  by ; 


Fi  =  F) .  ei  (20) 

As  a  preliminaiy  conelusions  of  piopeny  fU.ll),  the  equations  (17)  and  (18)  contain  the 
contribution  of  all  the  barycentrlc  parameten  related  to  die  two  considered  bodies.  For  a 
general  system  in  which  the  jdt  body  is  not  a  tenninal  one.  these  equation.'  would  involve 
additional  tenns  corresponding  to  the  barycenmc  quantities  associated  with  the  bodies 
located  downstream  from  body ).  Equations  (17),  (18)  and  (20)  car.  jieiirore  be  used  to 
detect,  at  each  step  of  a  recursive  reasoning,  the  combinations  which  tiay  occur  in  the 
models. 

The  various  barycenmc  parameters  of  body  j  have  now  to  be  mvesttgated  in  order  to 
establish  the  recursive  relations  leading  to  St.  the  minimal  parametriaation  related  to  body  j. 

A.  A. 

Sific«  (he  frame  (U)  has  no  relative  angular  motion  with  respect  to  (X>).  the  components 
of  mbi  and  ^  are  also  constant  In  the  (X'}  frame.  Using  the  following  properties ' 

bua'^imbs.  (bi-fib)^  (21) 

we  can  wntc :  Ml  x  (m*  +  §^)mbl  +  inW  x  (5*  +  5*  S‘)J,y 

a  • 

and  looking  at  eq.  (18),  we  may  suggest  the  following  combinations : 
mb**  a  nib‘  +  mbl 

K**  =  K>-f  KJ-(T'if§»)  +  i^ro)  (23) 

where  it  must  be  noted  that  all  vectors  and  tensors  have  constant  components  m  the  {X‘) 


(23).  equations  (17).  <18)  and  <20)  arc  now  rewnticn  as  • 

P  s  lTr*(x*  •  g)  +  (w* +•  5*  5*)  mb*‘ •♦■  nT.!  z)  (24) 

U  s  2>  X  P  +  mb*'  X  (x*  -  g)  ■^  K**  K**  m* 

Pi  X  nD  zJ  +  zJ  X  FJ  +  mb)  x  zi  ( 25 ) 

Fi  =  e J .  m’i  (xJ  •  g)  +  e J .  (A*  +  5')mbJ  1 26) 

This  new  pfcscntation  clearly  shows  that  JO  is  redundanL  On  the  contrary  m")  can  easily 
be  identified  from  (26)  by  choosing  an  excitation  such  that  xi  a  e )  qi  Finally,  the 
idenQfiability  of  rnbi  can  be  analysed  by  means  of  its  individual  conmbudon  to  L'  given  by 
%i  ql  (yi  *  g‘  S‘)  rnW  rn^W  x  (j,J  qJ  2  §*  ei  rp  +  (w‘  -►  S>  5‘>  eJ  (^)  ( 27) 

and  by  its  conmbuaon  to  FJ  given  by  . 

£i .  (®*  +  5* 5>)inb>  (23) 

This  analysis  leads  to  different  combmadons  depending  on  the  panicular  values  of 
(17].  (n  the  genera,  case,  expressions  <27)  and  (28)  allow  the  idenuficanon  of  the  three 
components  of  mb)  using  the  dynamic  or  the  reacoon  mode*.  U  is  therefore  unnecessary  to 

include  the  bao'cenme  vector  r^b)  in  the  parameter  combinations  suggested  in  (23) 

If  the  mobility  of  body  i  is  restricted  (i.e.  o’  is  inemally  fixed),  the  minimal  set  of  parameters 
of  the  dynamic  model  depends  on  expressions  (28)  and  the  projecDon  of  (27)  onto  the  fixed 
direcuon  w  of  o’.  In  this  case  the  component  mbi  of  m^bl  along  this  direction  is  not 
idenufiable  using  the  dynamic  model.  Moreover,  if  $'  ■  0  or  if  the  direction  of  coincides 

with  <1.  the  two  normal  components  mbj  and  mbi  also  disappear  from  (28)  and  the 
projecuon  of  (27)  In  both  cases  the  parameter  combmauons  (23)  must  consequently  be 
applied  to  (he  components  of  ni,bl  which  become  redundant  for  the  dynamic  model  The 
results  may  be  summanzed  as  indicated  in  table  2  for  die  dynamu  model. 
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gencraicasc  (Tin.  mb{.  mbj.  ml^) 


redefinition  of  the  carrying  body  i 
barycentrio  parameters 


m*‘  = 

1^*'  3  m_b‘ 
K**3KUKJ 


(^.  mbj,  mbt) 


mb*‘  3  mb*  +  mbi  w 
K*i  3  K'  ■*.  10  -mbi  (PJ  w  -4-  w  PJ) 


m  **  3 

mb*'  3  mb*  +  mbJ 


ineraally  fixed 
with  a  (0*  eJ 
or  U*  a  0 


Table  2  .  Combmauon  rules  for  pnsmauc  lOiAis  in  ibe  dynamic  model. 


K*«  a  K*  +  ip  .  (  PJ  [u) 


Similar  conaideratioiu  can  be  applied  to  the  reacnon  model  in  which  less  ccmponents  axe 
redundant  because  this  model  can  retain  all  the  components  of  relation  (27)  Tht  results  axe 
summanzed  as  indicated  in  uble  3. 


<0* 

angular  velocU 

0/  body  i 

5} 

minimal  set  of 
body  J  parameters 

eV 

redefinition  of  the  carrying  body  i 
baryeentric  parameters 

Scncral  case 

(r^,  mb},  mb}) 

o'**  3  ^ 

mo**  3  m,b' 

K**3Ki  +  kj 

mertially  fixed : 

m*  3  (i)‘  w 

(m'l,  ml^.  mb},  mbi) 

m”**  3  rap 
mb**  3  inb* 

K*'  =  K'  +  KJ 

m*  inerually  fixed 

with  (0*3(0*  eJ 

or  (0*  3  0 

(ml.  mbJ) 

m***  3  m^ 

1^**  3  inb*  +  mb}  eJ 

K*'  =K'  +  KJ  -mbid'JeJ  +  fn'O 

Table  3  .  Combination  rules  for  pnsmauc  joints  in  the  reacuon  model. 

For  both  models,  the  indicated  rules  must  be  aj^lied  recursively  from  the  end(s)  of  the 
structure  towards  its  base  in  order  to  determine  the  minimal  sets  of  parameters  for  ihe 
whole  system 
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-1  5  REVOLOTB  JOINT 

Thi  inzxUar  velocuv  and  acceleration  of  body  j  are  • 

^  s  0)*  '<•  eJ  4^ 

^  3  w*  +■  K  e  J  4^  +  e)  q  J 


,  /  »«<ri 

5/ 


Fig.  7  ;  Rcvoluie  joint  recursive  moOe!. 

Since  again  no  a  pnori  aasnmpuon  ia  made  concerning  the  mobility  of  the  carrying  body 
for  the  general  case,  die  veaor  forms  of  eqs.  (6)  and  (7)  are  retained  t 


Y' '  attached  to  body »  SViihoui  loss  of  generality,  this  frame  is  chosen  such  that  =  eJ 
Due  to  the  rotation  q),  the  components  of  KJ  in  the  (Y*)  basis  are  given  by  means  of  the 
symmetnc  mainx 

^  cos(2<lJ)Kj-sm(2<j))K',y+K{  ...  ^ 

cos(2il))K{j,*sin(2<}l)Kj  -cos(2q))K'+sm(2!)J)KJyTKj  (361 

eos(<t))KJj-sin((}l)K*j  sin(<}l)KJj-«:o!((}l)K' ^  ^ 

whtre:  -37i 

1  2  <12 

As  J  preliminary  result,  this  expression  shows  Uiai  the  oomponenis  ^  and  will  only 
appear  through  the  combinations  K*  and  Kj.  The  component  is  obviously  idenufiable  in 
y  .  y  via  an  excitaoon  motion  for  which  ^  q).  The  following  corabinauons 

mb*'  =  nib'  +  mbj  gi 

K*i<iS'.mbi(T'j£J  +  aT«)-  K'liji  (38) 

arc  suU  applicable.  Indeed  ii  is  easy  lo  see  Uiai  if  wr  Introduce  these  combmauons  inio 
equauon  (31)  of  £'.  then  use  (35)  the  only  residual  term  that  mvolves  mt4  independently  is 

(2S'elq)*tlql  +  jJ*l(ql)^)£)rai4  (39) 

and  vanishes  because  eieJ  s  o.  Introducing  (3$)  into  equation  (32)  of  L‘  leads  to  the 
following  residual  term  : 

(r ‘  +  Ml)  X  (  2  5*  eJql  +  V 

Ahich  vanishes  for  the  same  reason  "nie  individual  coninbuuon  of  mbj  also  disappears  in 
i34)  As  a  consequence,  this  component  cannot  be  identified  and  is  redundant.  Similarly. 

Uiing  (29)  and  (30).  the  individual  coninbunon  of  IC5  » •  Kj  reduces  m  (32)  to 

Ki  i>  q' + E'  o'  k's  £'  q*  *•  («'  Ss  •  si  £'  •  <k5  e')')  e‘  q)  (•»  i ) 


e).  K'j^+e). 


ft  IS  easy  to  venfy  that  both  residua!  comnbuuoiis  vanish  so  that  Ks  is  also  a  redundant 
parameter. 


In  i^e  general  case,  i  e  when  the  mobility  of  the  casing  body  is  not  restrtcied.  ail  'Jie 
'incr  com'poncnis  of  rnbi  and'Kl  arc  idemifuble  m  the  dynamic  model  as  well  as  m  the 
'eacuon  model  [10.171.  As  for  the  pnsmatic  joint.  if,m*  is  mcmally  fwtd  additional 
(.cmpcncnts  of  rnW  and  Ki  can  disappear.  Th'c'rcsults  are  summarized  in  tables  4  and  5 
respecuvcly  for  Uie  dynamic  and  reaction  model. 


'  m*  •' 

angular  velocity  of 
the  carding  body  i 

minimal  set  of 
body  i  parameters 

e'<i‘ 

redefin^n  of  the  carrying.body  i 
baryceniHe  parameten 

gensral  case 

(mbi.mbJ.K'y.Ki. 

raT •'  a  rn* 
a  n^b*  ■*•  mb*^  el 

K*'  =  K‘ .  mb’j  (PJ  eJ  +  el  PI)  •  K{  el  el 

a  OJ'  CJ 

(mbi.mbj.  I^) 

•'  1 

i^*'  a  mb'  mb^j  el 

IC*'  =  K*  ■  mb'  (I'j  eJ  +  eJ  PJ)  •  k'  ej  eJ 

a  <!)' 

Vj  tt  xi  t), 

and  g  s  g  el. 

(4) 

^•1  a 

itA*'  a  tnb'  -f  mbj  f} 
g.i.  S‘-mb'(I*'eU£Jl>J).K,'CJjJ 

:  Combinaaon  rules  for  revolute  joints  in  the  dynamic  model. 


anguiar  velocity  of 
ihe  carrying  body  i 


general  case 


redefinition  of  the  carrying  body  i 
barvcentne  parameters 


m  •'  »  ra^ 
a  :nb^  4-  mb^  ti 

Iv  K«'  *  K>  •  mb'  (Tm  i)  *  j)  PJ)  ■  k'  eJ  eJ 


(mbj.mby.  mb*' »  mb*  +  mb^jJ 

K**  =  K*  •  mb'  (T'J  eJ  +  eJ  pj)  ■  k'  eJ  e) 


m  •*  *  m* 

mb** «  mb*  +  mb^,  el 


y  =  (i)‘  el, 
Vl- iUeJ. 
and  g»gel 


Table  5  '  CcMibtnauon  rules  for  revolute  joints  m  the  reaction  model. 


(mb{.  mb*' «  rnb*  +  el 

ic|j.  ^*1  _  ^  j'tjj .  ^1  |j 


■# 


5.  Application  to  the  PUMA  robot 

Acconlmg  to'  the  tecuhive  rules  given  m  table  5.  the  redefined  (non*zero)  baryccninc 


parameters  6*  of  the  PUMA  robot  arc  : 

/  rn*^ 

mb/ 

K/y 

K-i 

K? 

K'/r 

* 

«d= 

1  ,  *2 
!  ra  raby^ 

•2 

mb/ 

K/ 

•^7 

•  '> 
K,‘ 

k)\ 

^  rn'‘*  mb** 

mb/ 

kH 

kV 

k' 

si 

oisong  which  the  minimal  set  of  non  redondant  panmeiers  is  given  by  : 

rob/  Ky-  Ky- 

Indeed,  the  barycemnc  masses  rn*  {ia| . 3)  are  redundant  while  mbj*.  and  K*^ 

disappear  because  of  the  restncted  mobiUty  of  body  I  a  0.  xN  0,  and  g  n  g  e  ^). 


For  example  the  elation  Q 1  of  the  first  joint  can  be  rewnnen  as  follows ; 


QlaKlZZ<qppl 

>K2u«qppU$2«S2 

♦K2a«qppl*C2*C2 

♦K3«*qppUS23*S23 

*K3u*qppl*C23*a3 

>mb3e«2«<ippt«123z<S2«S23 

♦K2yz*qpp2*C2 

♦K3yz»qpp2*C23 

•mbJy*qp^2*l23z*C2 

-K3yz«qpp3*C23 

’K2yz*qp2»qp2*S2 

•K3yz»qp2*qp2*S23 

♦mb3y*qp2*qp2«l23z*S2 

♦K2«*qpl*qp2*S22 

K2i2*<ipI*qp2*S22 

♦K3xx*<5»Uqp2*S2233 

•K3z2*qpl'qp2*S2233 

♦mb3z*2*qpl*<B>2*l23z*S223 

•K3y2*qp3*qp3*S23 

»K3«»qpl*qp3*S2233 

•K3zz*qpl*<jp3*S2233 

+mb3z«2*<lpl*qp3*123z*C23«S2 

-K3yz*2*<c>2*qp3*S23 


QtKK*lzz*qppl 

•fK*2d*qppl*C22 

♦K3d*qppl*C»33 

^b3z*2*qppl»l23z*S2«S23 

♦K*2yz*qpp2*C2 

+K3yz*qpp2*C23 

♦K3yz*qp^*C23 

•K*2yz*<D)2*qp2*S2 

•X3yz*qp2*qp2*S23 

.K*2d*qpl*qp2*S22 

.K3d*qpl*c|p2*S2233 

tmb3z*2*(g>I*qp2*123z*S223 

•IOyz*qp3*qp3*S23 

.K3d*qpl*qp3*S2233 

♦inb3z*2*qpl*qp3»123z»C23*S2 

.K3yz*2*qp2*qp3*S23 


{2S 


6.  Conclusions 


\  vi-'jrsive  method  of  dcicrmmmg  uic  minimum  set  of  dynamic  parameters  of  a  iree-like 
muliibody  system  has  been  prcscnied.  Csmg  simple  rules,  the  number  of  sndependant 
dynamic  parameters  can  be  determined  a  pnon.  Depending  on  the  mobility  oC  me  first  joints 
of  the  kinematic  chain,  this  number  is  equal  to  or  less  than  4npn$matic  ''^revoiutc  ^itiie  the 
total  number  of  ineaial  parameter  which  is  commonly  used  is  given  by  KXnpnsmanc 
ttfcvolute)-  reduction  of  mdependant  parameters  due  to  restneted  mobility  is  also 
obtained  from  these  rules  m  a  straightforward  manner.  For  instance,  the  first  revolute  joint  of 
ihe  Puma  arm  being  vertical,  it  can  be  seen  from  uble  4  that  9  parameters  disappear  from  the 
dynamic  model. 
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ABSTRACT.  Multibody  dyn^oucs  mvoWot  the  generttioa  uid  solution  of  the  equa¬ 
tions  of  motion  for  a  system  of  connected  material  bodies.  The  subject  of  this  paper 
is  the  use  of  graph-theoretical  methods  to  ^present  multibody  system  topologies  And 
to  formulate  the  desired  set  of  motion  equations;  a  discussion  of  the  methods  anil- 
able  for  solving  these  differential-algebrvc  equations  is  beyond  the  scope  of  this  woik. 
After  a  brief  introduction  to  the  topic,  a  revieiw  of  linear  graphs  and  their  associ¬ 
ated  topological  arrays  is  presented,  followed  in  t*im  by  the  use  of  these  matrices  in 
generating  various  graph-theoretic  equations.  The  appearance  of  linear  graph  the¬ 
ory  in  &  number  of  existing  muliibody  formdations  is  then  discussed,  distinguishing 
between  approaches  that  use  absolute  (CattesiM)  coordinates  and  those  that  em¬ 
ploy  relative  (joint)  coordinates.  These  formulations  are  then  contrasted  with  formal 
graph-theoretic  approaches,  in  which  both  the  Idnematic  and  dynamic  equations  are 
automatically  generated  from  a  single  linear  graph  representation  of  the  system.  The 
paper  concludes  with  a  summary  of  results  and  suggestions  for  further  research  on  the 
graph-theoretical  modelling  of  mechanical  systems. 

X.  Introduction 

A  multibody  system  is  hereby  defined  as  a  finiit  number  ofmaienal  bodies  connected  m 
on  oritfrory  fashion  by  mechanical  joints  that  limit  the  relative  motion  between  pairs  of 
bodies.  Practitioners  of  multibody  dynamics  study  the  generation  and  solution  of  the 
equations  governing  the  motion  of  such  systems.  Several  different  approaches  for  sys¬ 
tematically  formulating  these  equations  of  motion  have  been  developed,  and  encoded 
in  numerical  or  symbolic  computer  programs.  Such  programs  relieve  an  analyst  of  the 
enor-prone  labour  involved  in  deriving  the  governing  differential-algebraic  equations 
by  hand.  For  the  program  to  be  applicable  to  a  wide  range  of  mechanical  systems,  the 
topology  of  which  is  specified  by  the  user  at  execution  time  and  is  not  known  a  pnon, 
the  underlying  formulation  must  somehow  represent  the  connectivity  of  the  sy^item 
and  use  this  topological  information  during  the  derivation  of  the  equations  of  mction. 

Linear  graph  theory  is  that  branch  of  mathematics  that  studies  the  description  and 
manipulation  of  system  topologies.  Interestingly,  the  extent  to  which  this  theory  has 
been  k.corporated  into  current  multibody  dynamic  formulations  ranges  from  a  bare 
minimum,  typically  in  approaches  that  use  absolute  coordinates  to  describe  the  motion 


01  each  body,  to  a  maximum  m  tormal  graph^theoretic  procedures  It  is  the  ;oal  ot 
this  paper  to  examine  this  apparent  conundrum  m  some  detail,  by  explicitly  reternng 
to  a  number  of  existing  formulations 

The  paper  oegins  with  a  brief  review  of  ^nite  directed  linear  graphs  and  associated 
mathematical  theorems,  followed  by  a  discussion  of  the  minimal  use  of  such  graphs 
ID  absolute  coordinate  formulations.  This  in  turn  is  followed  by  an  examination  of 
how  linear  graphs  are  used  to  represent  system  topologies  in  formulations  that  employ 
relative  joint  variables  as  generalized  coordmates.  Finally,  a  number  of  approaches  that 
rely  entuely  on  graph^theoretie  techniques  to  automatically  formulate  the  equations  of 
motion  are  described.  The  paper  concludes  with  a  summary  of  results  and  suggestions 
for  future  exploitation  of  linear  gtaph*theoretic  methods  in  multibody  dynamics. 

2.  Review  of  Graph*Theoretical  Methods 

The  study  of  linear  graph  theory,  one  branch  of  the  wider  held  of  combmatonal  math¬ 
ematics,  originated  with  Euler’s  famous  solution  [1]  to  the  problem  of  the  Kdnigsberg 
bridges  m  1736.  A  complete  review  of  the  contributions  to  linear  graph  theory  since 
then  it  beyond  the  scope  of  this  article.  Instead,  attention  will  be  directed  on  those 
graph  theorems  that  have  application  to  the  dynamic  analysis  of  multibody  systems. 
In  consideration  of  the  previous  dehnition  of  a  multibody  system  u  a  hnite  number  of 
connected  bodies,  a  discussion  of  infliute  or  unconnected  graphs  is  excluded  from  this 
review.  Furthermore,  attention  will  be  restricted  to  the  study  of  directed  graphs,  since 
their  undirected  counterparts  hnd  less  application  in  multibody  dynamics.  In  sum* 
mary  then,  the  following  review  is  limited  to  connected  hnit«  directed  Ime&r  graphs 
and  their  associated  mathematical  theorems.  For  a  more  complete  discussii  .n  of  linear 
graph  theory  and  its  application  to  physical  systems  analysis,  the  reader  is  directed  to 
references  (2*6|. 

2.1  REPRESENTATION  OF  TOPOLOGY 

A  liuear  graph  is  a  collection  of  edges,  no  two  of  which  have  a  point  m  common 
that  IS  not  a  vertex.  In  turn,  an  edge  ts  defined  as  a  bne  segment  together  with  its 
distinct  endpoints,  and  a  vertex  (or  node)  is  an  endpoint  of  an  edge.  The  topology  of 
a  unear  graph  is  completely  defined  when  one  speafies  which  edges  are  incident  upon 
(connected  to)  each  and  every  vertex  of  the  graph. 

To  illustrate  the  use  of  linear  graphs  in  representing  topology,  consider  the  diagram 
IQ  Figure  1  which  depicts  an  electrical  network  consisting  of  two  inductors  {L\,  Lj), 
three  resistors  (Rj,  H4,  Rt),  a  capacitor  (C«),  and  a  voltage  source  (Vr).  Figure  2 
shows  the  linear  graph  which  is  topologically  equivalent,  or  isomorphic,  to  the  electrical 
network.  This  graph  is  constructed  by  drawing  a  node  for  each  point  at  which  two 
physical  elements  connect,  and  by  replacing  these  elements  with  directed  edges  on  a 
ons*to-one  basis.  The  direction  (arrow)  assigned  to  each  edge  is  arbitrary  and  serves 
only  to  provide  a  reference  direction  for  “through”  and  “across”  variables,  which  are 
defined  m  '  subsequent  section. 

FVom  the  linear  graph,  one  can  construct  the  incidence  matrix  j/iV|  which  contains 
a  complete  topological  description  of  the  ongioal  physical  system.  This  1$  a  v  x  e 
matrix,  where  v  is  the  number  of  vertices  in  the  graph,  and  «  is  the  number  of  edges 


Figure  1:  EleetriciJ  Network  Exuuple 


The  (t'lj)  entry  in  j/JV]  it  equ»l  to  (-l,+l,0)  if  edge  y  it  (negntively,  pciitively,  not) 
incident  upon  node  t.  The  directed  edge  j  it  potitirdy  incident  upon  node  t  if  it  points 
towards  the  node,  and  negativdy  incident  if  it  it  directed  away  bom  the  node.  At  an 
example,  the  inddence  matrix  for  the  linear  graph  m  Figure  2  takes  the  form: 
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la  which  the  vertices  usod&ted  with  tows  4ttd  the  edges  wiodated  with  colui^as  h&Te 
been  explicitly  labelled.  One  can  see  Crom  this  example  that  the  tows  of  [/iV]  ue  &ot 
Useaxly  independeat,  siace  their  sum  is  a  row  coatainiag  all  zeroes.  The  (v  -  1)  x  e 
reduced  incidence  matrix  (Aj  is  obtained  by  deleting  any  one  row  of  [/AT];  the 
remaining  tows  of  (4|  are  linearly  independent,  and  the  vertex  cnrrespnnduig  to  the 
deleted  row  is  referred  to  as  the  datum  node. 

Au  important  concept  in  linear  graph  theory  is  that  of  a  drcuit,  which  is  a  subset 
of  a  graph  (or  subgraph)  such  that,  on  every  vertex,  there  are  incident  exactly  two 
edges.  In  other  words,  a  drcut  is  a  closed  loop  of  edges.  With  this  concept,  one  can 
define  a  spanning  tree,  which  is  a  subgraph  containing  all  the  vertices  of  the  original 
graph,  but  no  drcuits.  The  (v  ~  1)  edges  in  a  tree  of  the  graph  are  called  branches, 
whereas  the  remuning  edges  in  the  complement  of  the  tree,  or  cotree,  are  known  as 
chords.  One  possible  spanning  tree  for  the  graph  in  Figure  2  has  been  d^awn  with 
thick  lines  and  consists  of  edges  Lit  Lu  Rtt  LUt  and  The  remaining  edges  (7«  and 
V-r  comprise  the  chords  of  the  cotree.  Having  defined  the  concept  of  a  tree,  two  new 
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Figure  2:  Lineax  Grtph  Isomorphic  to  Electnc&i  Network 

lopoiogicsi  matrices  caa  now  be  introduced  —  the  fundamental  cutset  matrix  and  the 
fundamental  circuit  matrix. 

A  cutset  is  a  •ubgraph  of  a  connected  linear  graph  such  that,  when  deleted,  the  graph 
is  left  in  two  distinct  parts.  A  fundamental  cutset,  or  {'cutset,  is  a  cutset  consisting 
of  one  branch  from  the  tree  and  a  minimal  numl  er  of  chords  such  that  no  subgraph 
of  the  cutset  is  itself  a  cutset.  As  an  exaiiiiK  the  ^>cutset  corresponding  to  branch 
L\  in  Figure  2  consists  of  t\  and  V?  th^t  uode  a  is  not  deleted  along  with  the 
cutlet  edges  and  constitutes  one  of  the  two  remaining  parts  of  the  graph).  There  will 
be  (v  - 1)  f'CUtsets  for  a  given  linear  graph  and  tree,  &om  which  one  can  construct  the 
fundamental  cutset  matrix  \CV].  The  (t,;)  entry  of  \CV]  is  zero  if  edge  ;  is  not 
in  the  f'cutset  corresponding  to  branch  t,  and  (-1,4*1)  if  edge  ;  is  in  the  f'Cutset  and 
has  the  (opposite,  same)  orientation  as  branch  t.  With  this  deftmtion,  the  (v  -  1)  x  e 
matru  [CV]  takes  the  general  partitioned  form: 

!OT1=[(I.I|W)  (2) 

in  which  jl(j  is  a  square  uxut  matrix  corresponding  to  the  tree  branches  in  the  ftrst 
(v  -  1)  columns,  and  (A«l  i»  the  remaining  (v  -  1)  x  (c  —  v  4*  1)  submatnx.  For  the 
linear  graph  m  Figure  2,  the  fundamental  cutset  matrix  takes  the  specific  form: 

1  0  0  0  0  0  -1 

0  I  0  0  0  I  0 

[CV]  =  0  0  1  0  0  1  0  (3) 

0  0  0  I  0  -1  1 

0  0  0  0  I  0  1 

An  important  result  from  bnear  graph  theory  is  that  the  fundamental  cutset  matnx 
[CU\  1$  tow'equivalcnl  to  the  reduced  incidence  matrix  (A).  In  other  words,  \CV' 


need  not  be  constructed  using  its  definition  —  it  c&n  be  obtained  through  simple  row 
operations  on  (/1|.  Venfic&tion  of  this  theorem  for  the  linear  graph  in  Figure  2  is  left 
to  the  reader. 

A  fundamental  circuit,  or  f«circuit,  is  a-circuit  in  which  one  edge  is  a  chord  &om 
the  cotree  of  the  graph,  and  all  the  remaining  edges  ue  branches.  To  illustrate,  the 
f.circuit  corresponding  to  chord  C«  in  Figure  2  ^o  contains  branches  Li,  R^,  and 
R4.  There. will  be  (e  —  v-t- 1)  f*circuits  for  a  given  graph  and  tree,  horn  which  the 
fundamentid  circuit  matrix  [C/|  can  he  constructed.  The  {i,j)  entry  of  (C/]  is 
zno  if  edge  j  is  not  in  the  f>circtut  corresponding  to  chord  t,  and  ("1,  +1)  if  edge  j  is 
in  the'f'circuit  and'has  the  (opposite,  same)  direction  as  chord  j  as  one  travels  around 
the  circuit.  With  this  definition,  the  (e  ~  v  + 1)  x  e  matrix  |C/)  can  be  written  in  the 
general  form: 

=  [lB.l|(l.))  (4) 

where  [Id  is  a  square  unit  matrix  corresponding  to  the  cotree  chords,  and  [5d  is  the 
remaining  (e  -  v  +  1)  x  (v  -  1)  submatrix.  The  specific  form  of  \CI\  for  the  example 
in  Figure  2  is: 


Another  important  linear  graph  theorem  [6]  states  that  the  rows  of  the  circuit  ao^ 
cutset  matrices  for  a  given  graph  and  tree  are  orthogonal,  or  mathematically, 

lCillCtn’-=(Ol  (6) 

in  wUch  the  superscript  T  represents  the  transpose  operation,  and  [Cj  is  a  (e  -  v«f  1)  x 
(v  1)  matrix  containing  all  zeroes.  Substituting  equations  (2)  and  (4)  into  equation 
(6)  and  rc'arranging,  one  can  show  that: 

iB.i=-!>4.r  (7) 

which  can  be  verified  for  the  linear  graph  in  Figure  2  by  examining  the  specific  form 
of  equations  (3)  and  (5). 

In  summary,  the  incidence  matrix  [/iV|  contains  a  complete  topological  description 
of  a  given  Unear  graph.  The  nonsingulat  reduced  incidence  matrix  (A)  is  obtained  by 
deleting  a  row  of  [IN]  corresponding  to  the  datum  node.  By  selecting  a  spanning 
tree  and  numbering  the  first  (v  —  1)  columns  of  [A]  to  correspond  to  the  branches, 
the  fundamental  cutset  matrix  (CC/)  can  be  obtmned  through  simple  ro'v  operations. 
This  topological  matrix  explidtly  shows  (v  1)  independent  ways  in  which  the  given 
linear  graph  can  be  cut  into  two  distinct  parts  ~  a  result  that  is  used  later  in  this 
paper  to  generate  the  force  equilibrium  equations  for  mass  elements  in  a  multibody 
system  without  constructing  the  conesponding  fitee'body  diagrams.  The  fundamental 
circuit  matrix  [C/j  can,  in  turn,  be  obt^ed  directly  &om  [CU]  using  equation  (7) 
to  construct  the  (B|)  submatrix.  Upon  completion,  (C/)  can  be  used  to  identify  an 
independent  set  of  (e  -  v  + 1)  circuits  in  the  given  graph,  an  application  of  particular 
relevance  to  the  lunematic  analysis  of  multibody  systems  with  closed  loops. 


2.2  GRAPH-THEORETICAL  EQUATIONS 

The  circuit,  cutset,  ^nd  incidence  matrices 'h^ve  mote  than  topolo^cal  significance  — 
they  can  also  be  used  to  generate  the  governing  equations  for  the  physical  system  to 
which  the  linear  graph  is  isomorphic.  This  fact  was  recognized  almost  four  decaaes 
ago  by.  Trent  |o|,  who.inltoduced  the  concept  of  through  and  across  variables  m  order 
to  $e)‘up  these  equations. 

A^through.variable  is  a  physical  variable,  associated  with  an  edge  of  a  graph,  that 
wouidvbe  measured  by  an  instrument  placed  in  senes  with  the  corresponding  element 
in- the  original  network.  In  the  electrical  network  example  in  Figure  1.  an  appropnaie 
through  variable  would  be  the  current  through  an  element.  For  a  multibody  system, 
the  relevant  through  vanables  are  forces  or  torques.  Regardless  of  the  type  of  physical 
system,  the  above  definition  of  a  through  vanablc  guarantees  that  the  '‘Vertex  Postu¬ 
late”,  which  states  that  the  sum  of  through  vanabUs  at  any  node  of  a  system  grapn 
must  equal  zero  when  due  account  ts  taken  of  the  onentaiton  of  edges  incident  upon 
that  node,  is  satisfied  for  the  linear  graph.  Essentially,  the  Vertex  Postulate  represents 
a  generalization  of  Kirchoff’s  Current  Law,  &om  electrical  network  theory,  that  is  &p- 
pUcable  to  all  physical  systems.  It  can  be  expressed  mathematically  for  &il  v  nodes  in  & 
graph  by  premultiplying  the  column  matrix  of  through  variables  {r}  by  the  incidence 
matrix: 

l/iVKr}  =  {0}  (8) 

where  {0}  is  a  v  x  1  column  matrix  of  zeroes. 

To  obtain  a  linearly  mdependent  set  of  equations  in  the  through  vanables,  |/«V]  in 
equation  (S)  can  be  replaced  by  either  the  reduced  incidence  matrix  [A]  or  the  cutset 
matrix  [CU].  In  the  Utter  case,  and  using  equation  (2),  the  resulting  equations  can  be 
solved  explicitly  for  the  (v  -  1)  through  vanables  {r*}  associated  with  the  branches: 

{r.}  =  -Kl{r.}  (9) 

in  which  {tj}  are  the  cotree  through  vanables.  If  these  Utter  vanables  are  known,  then 
{f{}  can  be  calculated  directly  from  equation  (9).  It  is  for  this  reason  that  the  cotrcc 
and  tree  through  variables  are  referred  to  as  “primary”  and  “secondary'’  vanables, 
respectively.  Using  equation  (3)  for  the  electrical  network  example,  equation  (9)  takes 
the  specific  form: 
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which  is  equiialent  to  the  set  of  equations  obtained  by  successive  appbeations  of  Kir- 
chofT’s  Cunent  Law  to  the  network. 

An  across  variable  associated  with  an  edge  is  a  physical  vanable  that  would  be 
measured  by  an  instrument  placed  in  parallel  with  the  corresponding  element  in  the 
physical  network.  In  electrical  systems,  voltage  is  the  most  common  example  of  such 
vanables,  whereas  m  mullibody  systems,  relative  displacements,  velocities,  and  accel¬ 
erations  are  all  appropnate  across  vanables.  In  general,  the  den^’atlves  and  mtegrais 


of  across  vaxiables  are  themselves  across  variables,  as  are  vectors  whose  scalar  compo* 
neats  correspond  to  across  y^ables.  A  rigorous  definition  of  across  variables  is  that 
they  satisfy  the  **Circuit  Postulate”,  namely  that  ihe  sum  of  across  varto&fcs  around 
any  circuit  of  a  graph  must  equal  zero  when  due  account  ts  taken  of  the  dtreciton  of 
edges  tn  ihe  eircutf. 

To  obtain  a  linearly  independent  set  of  equations  that  are  mathematically  equivalent 
to  the  Circuit  Postulate,  one  need  only  premultiply  a  column  matrix  of  across  variables 
{a}. by  the  circuit  matrix,  and  set  the  result  to'{0}: 

(c;i{a}  =  {0}  (U) 

Equation  (4)  can  be  used  to  express  the  (e  v  +  1)  across  variables  associated  with 
the  chords  {oe)  as  explicit  functions  of  the  tree  across  variables  {arj: 

{q,}  = -(B,i{aJ  (12) 

which  is  why  {at}  is  added  to  the  list  of  primary  variables,  and  {oe}  is  a  subset  of  the 
secondary  variables.  Using  equation  (5)  for  the  electrical  network  example,  equation 
(12)  takes  the  form: 

which  is  equivalent  to  the  independent  set  of  equations  obtained  by  applying  Kirchoif ’s 
Voltage  Law  to  the  inner  two  loops  of  the  network. 

With  e  primary  variables  and  another  e  secondary  variables,  the  total  number  of 
unknowns  is  2e.  Available  for  the  solution  of  these  unknown  quantities  are  the  (v  - 1) 
cutset  equations  (9)  and  the  (e  ~  v  +  1)  circuit  equations  (12)  —  a  total  of  e  linearly 
independent  equations.  The  remaining  e  equations  required  to  effect  a  solution  are 
obtained  &om  the  constitutive,  or  terminal,  equations  for  each  of  the  e  elements  m  the 
system.  The  terminal  equation  for  each  element  expresses  the  functional  relationship 
between  the  through  and  across  variables  and  the  independent  variable,  time.  As  an 
example,  the  terminal  equation  for  the  ideal  inductor  L\  shown  in  Figure  1  would  be: 

a.  =  (14) 

where  ai  corresponds  to  the  voltage  across  Lu  and  represents  the  current  pusing 
through  the  inductor.  For  a  threc'dimensional  multibody  system,  the  through  and 
across  variables  are  spatial  vectors  and  the  corresponding  terminal  equations  are  vec* 
torial  relationslups.  Regardless  of  the  type  of  system  under  study  however,  the  circuit, 
cutset,  and  terminal  equations  comprise  a  necessary  and  sufficient  set  for  the  solution 
of  all  unknown  variables  as  functions  of  time  (6).  The  advantage  of  using  these  for* 
mal  graph'tbeoretic  techniques  over  traditional  methods  of  formulating  the  governing 
equations  is  twofold: 

1.  the  topological  equations  are  clearly  separated  from  the  constitutive  equations 
for  the  elements  comprising  the  physical  system  under  study,  and 


;here  is  a  nunber  of  standard  graph*thcoretic  formulations  available  m  the  ht 
^ralure  ’’2-5!-fdf  systemaiicaily  establishing  the  governing  equations  —  the  par 
t'.cuiar  choice  of  formulation  method  is  made  based  upon  the  desired  hnai  form 
of  these  equations. 

Finally,  one  may  add  that  the  systematic  nature  of  formal  graph-theoretic  approaches 
make, them  quite  attractive  if  a  computer  implementation  is  desired. 

Before  ending  this  review  of  linear  graph  theory^  an  auxiliary  set  of  nodal  variables 
are  introduced.  Essentially,  a  nodal  va^able  corresponds  to  a  physical  variable  tuat 
would  be  measured  by  an  instrument  placed  between  (across)  the  relevant  node  and  a 
reference  datum  node.  For  an  electrical  network,  the  voltage  diiference  between  a  node 
and  the  ground  would  be  classified  as  a  nodal  variable.  In  a  multibody  system  the 
absolute  displacement,  velocity,  or  acceleration  of  a  point  relative  to  an  inertial  refer 
ence  frame  all  represent  nodal  variables.  The  reduced  incidence  matrix  [.'ti  provides  a 
convenient  means  for  transforming  between  the  nodal  {t;}  and  across  {a}  vananles  of 
a  system  graph: 

{«}  =  (/!)'•{,}  (15) 

The  nodal  transformation  equation  (15)  increases  the  total  number  of  available  equa¬ 
tions  by  (v  -  1),  which  corresponds  to  the  additional  (t»  *•  1)  unknowns,  the  auxiliary 
nodal  >*ariables. 

3,  Absolute  (Cartesian)  Coordinate  Formulations 

Attentior:  is  now  switched  to  the  other  main  topic  of  this  paper,  the  dynamics  of 
muitibody  systems.  An  example  of  such  a  system  is  the  planar  four-bar  mechanism 
shown  in  Figure  3,  which  consists  of  three  rigid  links  connected  by  ideal  revolute 
joints  to  form  a  closed  loop  with  the  ground  (the  fourth  “bar'*).  Assuming  that  a 
time-varying  torque  T{t)  is  applied  to  link  I,  the  goal  of  a  dynamic  analysis  would  be 
to  determine  the  configuration  of  the  system  at  each  instant  dunng  a  finite  interval 
of  time.  To  represent  the  configuration,  a  set  of  coordinates  that  uniquely  descnbe 
the  position  of  each  body  in  the  system  must  be  defined.  The  dynamic  analysis  is 
accomplished  by  generating  the  differential-algebraic  equations  (DAEs)  of  motion  and 
sohnng  them  for  the  time-varying  coordinates.  This  procedure  has  been  successfully 
automated  in  a  number  of  existing  multibody  programs  using  »  v-anety  of  different 
formulation  approaches. 

Several  of  these  approaches  make  use  of  absolute  coordinates,  which  descnbe  the 
position  and  orientation  of  each  body  in  the  system  relative  to  an  inertial  frame  of 
reference.  For  body  2  of  the  planar  four-bar  mechanism,  shown  in  Figure  4,  the  ab¬ 
solute  coordinates  ate  dehaed  as  the  Cartesian  coordinates  (znVt)  of  the  mass  center 
Cj  m  the  inertial  XY  reference  frame,  as  well  as  the  angle  9z  between  the  link  and  the 
positive  X  axis.  With  three  absolute  variables  per  body,  the  total  number  of  system 
coordinates  {p}  is  nine.  Obviously,  these  mne  coordinates  are  not  independent  since 
the  four-bar  mechanism  has  only  one  degree  of  freedom.  The  motion  of  individual 
bodies  IS  constrained  by  the  presence  of  kinematic  joints  between  adjacent  links:  reia- 
tionsbps  between  the  absolute  coordinates  are  obtained  from  a  consideration  of  these 
hoionomic  constraint  elements.  Specmcally,  each  pin  joint  requires  that  connected  end 


Figure  3:  Torque«Dnren  PIjaat  Four-BM  Mechaixitm 


poiflti  of  ndjuent  bodies  remein  coinddeat  duriag  any  motion  of  the  system.  Mathe* 
maticallyi  for  the  Idnematie  pair  coniistiiig  of  bodies  s — 1  and  t  connected  by  pin  joint 
Pii 

+  ■^cos^i-i  -  I, +  ^cos^,  =  0  (16) 

=  y.-i  +  -  yi  + jsin^i  =  0  (17) 

noting  that  U  is  the  length  of  uniform  link  the  terms  /o>  uid  ^4  ate  constants 
defining  the  positions  of  pins  P\  and  P4  in  the  inertial  reference  frame,  and  zq,  yo»  24, 
and  y4  are  all  identically  zero. 

Aiiembling  equations  (16)  and  (17)  for  the  four  pin  joints  results  m  a  set  of  eight 
nonlinear  algebraic  equations: 

Wp)}=m  (18) 

which,  by  themselves,  are  not  sufildent  to  solve  for  the  nine  absolute  coordinates.  To 
obtdn  a  second  set  of  equations  for  the  system,  one  can  write  the  equations  of  motion 
for  each  body  in  the  system,  by  applying  the  Newton*EuIer  equations  to  a  &ee>body 
diagram  of  each  link.  Note  that  the  reaction  forces  {A}  in  the  pin  joints  enter  explidtly 
into  these  expressions.  Assembling  the  nine  differential  equations  for  all  three  bodies 
mto  a  matrix  form  gives: 

=  {<?.}  (19) 

in  which  (A/«|  is  the  generalized  mass  matrix,  (Q«}  contains  the  applied  forces  and 
torques,  and  (J]  is  the  Jacobian  matrix  of  the  constraint  equations  (18).  In  explidt 
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Figure  4:  Frcc-Body  Diagram  of  Link  2 


formi  the  entries  of  [J]  are  given  by: 


-  ^ 
“  3p, 


(20) 


Together,  equations  (18)  and  (19)  constitute  a  set  of  seventeen  dijTerentia]>algebrajc 
equations  that  can  be  solved  for  the  nine  absolute  coordinates  {p}  and  eight  reaction 
forces  {i2}  as  functions  of  the  independent  variable,  time. 

The  approach  described  above  has  been  extended  and  applied  to  the  analysis  of 
threc'dimensional  systems  of  rigid  and  fiexible  bodies  connected  by  a  wide  vanety  of 
general  holonomic  and  noQ’holonomic  joints  Due  to  its  simplicity,  this  formula' 

tion  can  be  readily  implemented  in  a  computer  program  that  automatically  generates 
the  governing  DAEs  for  a  given  mechanical  system.  A  bbrary  of  constraint  equations 
for  a  vanety  of  kinematic  joints  can  be  created  in  advance  and  used  to  generate  the 
relationships  between  the  absolute  coordinates  of  two  bodies  connected  by  a  particular 
type  of  joint.  A  second  library  contuning  the  conesponding  Jacobian  matrix  for  each 
joint  can  also  be  created,  and  used  to  generate  the  system  Jacobian  matrix  [J]  by 
means  of  an  assembly  process  similar  to  that  employed  by  the  finite  element  method. 
The  generalized  mass  matrix  (A/«]  and  foraog  vector  {(?•}  can  be  constructed  directly 
from  the  input  data  provided  by  a  user.  Thus,  all  terms  in  the  governing  equations 
(18)  and  (19)  can  be  obtained  wihout  using  methods  from  Itnear  graph  theory.  As 
Haug  |9]  has  observed,  the  use  of  absolute  coordinates  in  the  underlying  formulation 
results  in  a  ^bypassing  [of]  topological  analysis”. 

Orlandea  et  al  |10]  have  used  an  even  larger  set  of  absolute  coordinates  than  that 
described  above  in  order  to  maximize  the  sparsity  of  the  resulting  DAEs,  which  are 
subsequently  solved  using  sparse  matrix  methods  and  an  unpheit  numerical  integration 
routine.  It  is  worth  noting  that  these  authors  make  explicit  reference  to  the  su^anty 
between  their  derived  equations  and  those  arising  in  linear  graph  theory;  speciHcail>, 
they  observe  that  equation  (19)  from  their  paper  represents  an  assembly  of  the  arcuil, 
cutset,  and  terminal  equations  that  would  be  obtained  from  a  network  model  of  their 
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mxxltxbody  system.  In  spite  of  this  compamon,  the  authors  assemble  their  equations 
without  exploiting  the  systematic  nature  of  a  gtaph>theoietical  approach.  Geradin  (II] 
uses  absolute  coordinates  in  a  finite  element  formulation  of  the  equations  of  motion 
for  flexible  multibody  systems.  Once  agm,  the  use  of  such  coordinates  eliminates 
the  need  for  bnear  graph  theory  since,  as  the  author  points  out,  “the  topology  of  the 
articulated  system  is  automatically  embedded  into  its  finite  element  description.” 


4.  Relative  (Joint)  Coordinate  Formulationa 

A  second  means  of  representing  the  time>varying  conJiguxation  of  a  multibody  system 
is  through  the  use  of  relative  coordinates.  These  coordirates  describe  the  relative 
position  and  orientation  of  two  adjacent  bodies  in  terms  of  variables  associated  with 
the  kinematic  joint  connecting  the  two  bodies.  A  joist  that  allows ;  degrees  of  freedom 
(where  ;  <  6)  contributes  j  variables  to  the  set  of  system  relative  coordinates  {9}.  As 
an  example,  the  relative  rotation  between  any  two  Hnlf*  is  Figure  3  can  be  described 
by  a  single  angle  ^  conesponding  to  the  revolute  joist  connecting  the  two  links.  The 
complete  set  of  three  relative  coordinates  for  this  four*bar  mechamsm  can  be  defined 
in  terms  of  the  previous  absolute  coordinates: 

^  =  dj 

<h  =  (21) 

corresponding  to  pin  joints  Pj,  and  Pj.  Note  that  it  is  not  necessary  to  define  the 
position  of  li^  4  (the  ground)  relative  to  link  3. 

If  the  multibody  system  has  no  closed  loops,  i.e.  it  has  a  “tree”  topology,  the  set 
of  relative  coordinates  is  equal  in  number  to  the  degrees  of  freedom  of  the  system. 
As  an  example,  if  pin  P|  were  removed  from  the  foui*bar  mechanism,  the  resulting 
opendoop  system  would  have  three  degrees  of  freedom.  Using  relative  coordinates  {9}, 
the  equations  of  motion  for  such  a  system  can  be  wri^^en  in  the  form: 

=  {<?,(<.?,<)}  (22) 

noting  that  reaction  forces  and  torques  m  the  jmnts  have  bci^n  eliminated  from  these 
equations  using  either  an  analytical  approach  (eg.  d'Alembert’s  Principle  or  Lagrange’s 
equations)  or  a  systematic  substitution  process  [14)  in  conjunction  with  the  Newton* 
Euler  equations.  Equation  (22)  constitutes  a  set  of  ordinary  differential  equations  that 
can  be  numerically  integrated  to  obtain  the  relative  coordinates  u  functions  of  time. 

These  same  equations  can  be  used  to  derive  the  DAEs  governing  the  motion  of  a 
multibody  system  with  closed  loops.  In  this  case,  the  relative  coordinates  are  no  longer 
independent  and  are  related  by  the  set  of  nonlinear  algebraic  constraint  equations: 

{«{,)}  =  {0}  (23) 

corresponding  to  the  equations  guaranteeing  closure  of  an  independent  set  of  loops. 
For  the  four*bai  mechanism,  these  loop  closure  equations  can  be  obtained  by  summing 
the  eight  joint  constraint  equations  (1$)  and  (17),  resulting  in: 

focos^o  +  ijcos^i  -r  Ijcos^j  +  Ijcos^s  —  UcosBi  =  0 


(24) 


-i-  liSmdi  —  --  /4sin^4  =  0  t-5) 

Denciag  s-s^o  aew  constants  C«  .aad  Cy.that  repfcseat  the  distance  between  pms  P, 
and  P*  in  the  A'  and  K. directions  respectively, 

Cg  =  /4Cos^4  *“  locos$o  (26) 

Cy  =  i'4smd4  -  /osia^o  i27) 

and  using  equations  (21)  to  replace  the  absolute  coordinates  with  their  relative  coun¬ 
terparts,  the  constraint  equations  (24)  and  (2S)  can  be  written  m  the  desired  form: 

'ti  =  /j  cos  T /j  cos(^i  +  ^) -f  ijcos(flii -f  T  Ijij)  —  C,  =  0  (2S) 

'fj  =  l\  sin  4>\  y  5in(^  4*  +  lj$in(0t  +  di  4*  —  Cy  =  0  (29) 

The  hnal  set  of  DAEs  is  obtained  by  removing  from  the  system  model  one  bnematic 
joint  for  each  independent  closed  loop.  The  motion  of  the  resulting  opendoop  system 
is  governed  by  equation  (22).  By  adding  to  this  equation  terms  corresponding  to  the 
reaction  forces  and  torques  in  the  joints  that  were  removed,  the  diiTerentiai  equations 
for  the  original  system  with  closed  loops  are  obtained: 

[".){?}  +  (/n^{A}  =  {(?,}  (30) 

where  {A}  is  a  set  of  Lagrange  multipliers,  and  (iTj  is  the  Jacobian  matnx  of  the  loop 
closure  constraint  equations: 

/f.,  =  ^  (31) 

Equations  (23)  and  (30)  constitute  the  final  set  of  DAEs  for  the  multibody  system, 
expressed  in  terms  of  relative  coordinates.  One  can  see  that  they  are  similar  m  fora  to 
the  corresponding  equations  (18)  and  (19)  tn  absolute  coordinates,  but  are  generally 
fewer  m  number.  The  generalized  mass  matnx  [AA)  is  smaller  and  less  sparse  than 
its  absolute  counterpart  (Af«|»  and  the  generalized  forcing  vector  is  a  complex 
function  of  the  relative  coordinates,  their  denvatives,  and  time.  Even  though  the 
loop  closure  equations  (23)  have  a  higher  order  of  nonlineanty  than  the  constraint 
equations  (18),  the  smaller  set  of  DAEs  for  relative  coordinates  can  be  solved  more 
efficiently  than  its  counterpart  in  absolute  coordmates.  However,  as  Nikravesh  ^8j  has 
pointed  out,  this  computational  advantage  is  offset  by  he  additional  labour  required 
to  generate  these  equations. 

One  source  of  this  additionU  labour  is  the  requirement  for  topological  processing 
when  relative  coordinates  are  employed.  The  reason  for  this  is  simple:  regardless  of 
the  type  of  approach  one  uses  to  derive  the  differential  equations  (30),  one  needs  ex¬ 
pressions  for  the  velocity  (eg.  to  formulate  the  kinetic  energy  for  use  with  Lagrange's 
equations)  or  the  acceleration  (eg.  using  the  Newton«Euler  equations)  of  each  body 
rc/ufive  to  an  tnerital  frame  of  reference.  For  a  particular  body  m,,  one  can  obta.n 
these  expressions  from  the  relative  coordinates  and  their  time  derivatives  only  if  one 
knows  the  identity  and  ordering  of  the  intermediate  bodies  connecting  m,  to  the  in¬ 
ertia  reference  frame.  In  bnef,  a  mathematical  description  of  the  system  topology  is 
required,  such  a  description  is  convemently  provided  by  linear  graph  theory 
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that  takes  the  general  form; 


m  = 


l^ol  i 

(5)  1 15-1 


ot  «pecificilly,  (or  ‘.he  lineu  graph  o£  the  four-bar  mechanism: 


(32) 
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.  0 
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Upon  ejcaminalion,  one  can  see  that  the  matrix  (lyi  is  exactly  the  negative  of  the  ind- 
denee  matrix  (7iV)  defined  in  Section  2  of  this  paper.  The  first  tow  of  [W]  corresponds 
to  the  datum  node,  and  the  (•)  superscript  is  used  to  identify  hinges  in  the  cottee  of 
the  graph.  Therefore,  the  n  x  n  submattix  (5),  where  n  it  one  lest  than  the  number 
of  nodes  (bodies)  in  the  system,  representt  the  tree  portion  of  the  reduced  inddence 
matrix  (/!].  The  inverse  of  this  matrix  waa  first  introduced  by  Btanin  (17)  and  called 
the  “node-to-datum-path  matrix”,  since  it  can  be  constructed  by  examining  which 
edges  lie  in  the  path  between  a  given  node  and  the  datum  node. 

Unaware  of  Branin’s  previous  work,  Roberson  and  Wittenhurg  (18)  re-invented  this 
matrix,  called  it  simply  the  “path  matru*  (Tj,  and  verified  the  relationships: 

(T)W  =  -{1}  (34) 

(TllSl  =  (5j(Tl  =  (1)  (35) 

where  {1}  is  a  column  matrix  of  n  elements,  each  equal  to  1,  and  [1|  is  the  n  x  n 
identity  matrix.  Wittenhurg  (14)  makes  extensive  use  of  the  (5|  and  (T)  matrices 
to  derive  the  differential  equations  (301  for  a  multibody  system.  Unfortunately,  the 
generation  of  the  constraint  equations  (23)  it  only  presented  by  way  of  three  example 
analytes.  This  drawback  wu  subsequently  addressed  in  (19),  in  which  Wittenhurg 
presents  a  systematic  procedure  for  formulating  the  loop  closure  equations,  once  again 
making  use  of  the  topological  matrices  (5)  and  (T). 

It  is  interesting  to  note  that  formal  graph-theoretic  methods  can  be  used  to  derive 
many  of  the  equations  appearing  in  Wittenburg’s  formulation.  To  do  to,  one  mutt 
identify  a  set  of  through  and  across  variables  (5j  that  respectively  satisfy  the  vertex 
and  circuit  postulates  for  Wittenburg's  linear  graph.  The  relative  rotational  velocities 
{Q}  form  a  natural  set  of  across  variables  for  this  graph,  and  must  therefore  satisfy 
the  fundamental  circuit  equation  (12): 

{a.}  =  -(B.){a,}  (36) 

where  {Qc}  and  {a,}  correspond  to  hinges  in  the  cotree  and  tree,  respectively.  Recall* 
mg  equation  (7)  and  using  the  interesting  fact  (17,19)  that  the  path,  reduced  incidence, 
and  cutset  matrices  are  related  by: 

lrl[5*|  =  (4.)  (37) 
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Sheth  and  Uicker  >151  recognized  this  fact  over  two  decades  ago,  when  they  usea 
Hamilton's  Principle  and  relative  coordinates  to  formulate  the  differential  equatioos 
for  a  multibody  system  consisting  entirely  of  closed  kinematic  loops.  To  obtain  the 
supplementary  <et  of  loop  closure  constraint  equations,  the  authors  construct  a  simple 
bnear  graph  representation  of  the  multibody  system,  in  which  nodes  represent  links 
and  edges  represent  kinematic  joints.  With  tbs  linear  graph,  the  authors  are  able 
to  derive  an  independent  set  of  loop-closure  equations  that  are  equivalent  to  the 
fundamental  circuit  equatioos,  with  the  relative  coordinates  playing  the  role  of  across 
variables.  Furthermore,  a  gtaph<theoretical  algorithm  is  employed  to  minimize  the 
number  of  joints  appearing  in  the  final  set  of  independent  loops.  It  is  possible  to 
identify  further  equivalences  between  the  equations  derived  by  Sheth  and  Dicker  and 
the  graph'theotetical  circuit  and  cutset  equations;  the  interested  reader  is  ceferred  to 
the  thesis  by  Li  (16] 

In  the  first  monograph  on  multibody  dynamics,  Wittenburg  [14]  makes  direct  use 
of  linear  graph  theory  to  represent  the  topology  of  a  system  of  rigid  bodies  containing 
both  open  and  closed  kinematic  loops.  Similar  to  the  model  employed  by  Sheth  and 
Dicker,  rigid  bodies  are  represented  as  nodes  of  the  graph  and  bnges  between  bodies 
appear  as  edges.  Wittenburg’s  graph  model  U  more  encompassing  however,  since  bs 
“hinge”  has  been  generalized  to  include  springs,  dampers,  and  other  connections  hav. 
ing  six  degrees  of  freedom.  In  addition,  WittenWg  makes  explicit  use  of  a  “spanning 
tree”  that  is  consistent  with  conventional  graph4heorettc  methods.  For  the  four>bar 
mechanism,  the  lineu  graph  thus  defined  takes  the  form  shown  m  Figure  5.  The  four 
nodes  have  been  labelled  as  m{,  where  nu  represents  link  t,  and  the  bnges  labelled 
P,  correspond  to  the  four  pin  joints.  The  edges  comprising  an  arbitranly*selected  tree 
are  drawn  as  solid  lines,  while  the  one  cottee  edge  is  dashed. 


}44 


one  cza  verify  that  equation  (36)  is  identical  to  Wittenburg’s  equation  (5.211),  which 
IS  used  to  hnd  an  expression  for  the  virtual  work  done  in  cut  (cotree)  hinges. 

An  app'ropriaie  nodal  *.>riable  for  Wittehburg’s  graph  is  the  difference  between  the 
absolute  angular  velocity  of  each  body  and  that  of  the  base  body  (node): 

(38) 

A  subset  of  the  nodal  transformation  equation  (15)  can  be  used  to  relate  this  set 
of  nodal  variables  {17}  to  the  tree  across  variables  {Ut}>  oite  recognizes  that  -{5| 
corresponds  to  the  tree  portion  of  the  reduced  incidence  matrix  [Aj: 

{a.}  =  -(SfCk) -«<,{!})  (39) 

Premultiplying  equation  (39)  by  one  obtains  Witteuburg’s  equation  (5.122): 

+  (40) 

which  is  subsequently  used  to  obtain  the  differential  equations  (22;  for  the  opendoop 
(tree)  portion  of  the  multibody  system.  For  a  further  discussion  of  the  relationships 
between  Wittenburg’s  formulation  and  formal  graph*theoretic  methods,  the  reader  is 
directed  to  the  forthcoming  paper  (20). 

If  one  is  only  interested  in  using  the  topological  description  to  generate  kinematic 
relatiottihipit  then  alternatives  to  a  linear  graph  representation  are  available  in  the 
literature.  As  an  example,  the  tree  topology  of  an  opendoop  multibody  system  is 
represented  by  Huston  and  Paiserello  (21)  using  a  “body  connection  array”,  which 
is  subsequently  employed  by  Amirouehe  (22)  to  generate  the  loop  closure  equations 
for  a  general  system  of  rigid  and  flexible  bodies.  Nikravesh  and  Gim  (23)  transform 
the  absolute  coordinate  DAEs  (18)  and  (19)  to  the  set  of  equations  (23)  and  (30) 
in  relative  coordinates  using  a  topology'dependent  velocity  transformation  matrix; 
Kim  and  Vanderploeg  (24)  have  presented  a  systematic  procedure  for  constructing 
this  matrix  using  a  modified  version  of  the  path  matrix  |7|,  in  which  all  -I’s  are 
replaced  by  +rs.  Pereira  and  Proen^a  {2Sj  have  applied  a  similar  transformation 
to  the  DAEs  for  a  multibody  system  containing  rigid  and  flexible  members.  Hiller 
et  al  (26)  have  presented  an  alternative  means  of  transforming  the  equations  from 
absolute  to  relative  to  (in  some  instances)  minimal  coordinates,  using  the  concept  of 
a  “Idnematical  transformer”  to  represent  a  closed  loop;  the  topology  of  the  complete 
system  is  contidned  in  a  block  diagram  of  these  kinematical  transformer  elements. 

Using  a  linear  graph  representation  similar  to  that  employed  by  Wittenburg,  Hwang 
at4  Haug  |27j  have  developed  a  recursii^  formulation  for  a  system  of  rigid  bodies  with 
closed  loops,  and  implemented  this  fotmoiaiion  on  a  computer  with  parallel  processing 
capabilities,  in  a  subsequent  formulation  for  flexible  multibody  systems,  Lai  et  al  [28] 
a^eved  a  greater  degree  of  parallelism  by  defining  an  “extended  graph”  in  which  nodes 
represent  reference  frames  attached  to  bodies  and  edges  represent  the  transformations 
between  these  Barnes.  It  is  interesting  to  note  that  this  graph  representation  is  very 
sinular  to  the  “vector«ne(work  model”  first  introduced  by  Andrews  and  Kesavan  [29], 
which  is  discussed  further  in  the  next  section. 


145 


3.  Graph'Theoretic  Multibody  Formulations 

ia  the  previous  section,  it  was  *  ‘Own  how  a  number  o£  current  muitiboay  dynamics 
formuiatioas  use  linear  graph  tb  ry  to  represent  the  system  topology  and  to  generate 
various  kinematic  relationsMps.  he  difference  between  such  approaches  and  a  format 
graph'theoretie  procedure  has  been  summanxed  by  Li  (16): 

'*To  appreciate  the  difTerence  between  an  ad  hoc  application  of  graph  theory 
to'  dynamics  and  a  graph*theoretic  approach,  one  must  understand  that 
a  terminal  graph  (edge)  is  part  of  a  mathematical  model  of  a  physical 
component.  If  the  individual  system  components  are  modelled  properly, 
the  resulting  system  graph  will  automatically  satisfy  the  cutset  and  circuit 
postulates.’* 

As  discussed  in  Section  2,  if  each  edge  is  associated  with  a  physical  component  and 
a  consistent  set  of  through  and  across  t'anables  is  chosen,  then  a  graph^theoretic 
formulation  will  automatically  provide  a  necessary  and  suifiaent  set  of  DA£$.  In  the 
formulations  discussed  in  the  previous  section,  the  edges  did  not  correspond  to  physical 
components  hut  simply  represented  the  connectivity  of  the  system.  It  is  impossible  to 
obtain  the  dynamic  equations  motion  directly  &om  sucb  a  linear  graph. 

One  of  the  first  applications  of  formal  graph<tbeotetic  methods  to  multibody  dy> 
oamies  resulted  in  the  “vector^network  method**  of  Andrews  and  Kesavan  ^29).  This 
graph'tbeoretie  formulation  was  used  to  lyitematically  derive  the  equations  of  motion 
for  a  three-dimensional  system  of  particle  masses.  More  recently,  it  has  been  extended 
to  the  analysis  of  two-dimensional  (16|  and  three-dimensional  (30j  constrained  mechani¬ 
cal  systems.  To  better  understand  this  formulation,  consider  the  vector-network  model 
of  the  four-bar  mechanism  shown  to  Figure  6.  In  this  graph  representation,  edges  rep¬ 
resent  the  position  vectors  corresponding  to  physical  components  while  nodes  represent 
connection  points  between  these  components.  In  addition  to  representing  the  three 
rigid  bodies  therefore,  the  ed^ee  mi,  mt,  and  locate  the  mass  centers  of  these  links 
relative  to  a  datum  node  0n  :d  in  in,  space.  Similarly,  edges  rs  and  r«  represent 
the  points  where  pins  P\  and  attach  to  the  ground.  The  "'ngtd-arm  ’  elements  to 
Jii  correspond  to  body-fixed  position  vectors  &om  the  mass  centers  to  the  points  on 
each  body  where  the  levc’ute  joints  are  connected.  The  driving  torque  is  represented 
by  the  edge  Tij,  while  the  remaining  edges  to  hn  correspond  to  pin  joints  Pi  to 
Pi,  respectively. 

The  vector-network  graph  is  significantly  more  complex  than  its  counterpart  in 
Figure  5  because  it  contuns  dynamic,  as  well  as  kinematic,  information.  The  existence 
of  torque  and  mass  elements  in  the  vector-network  model  is  evidence  of  this.  Of 
course,  the  vector-network  graph  also  contains  the  topological  information  provided 
by  Wittenburg’s  graph,  which  can  be  recovered  &om  Figure  6  by  deleting  the  dynamic 
mass  and  torque  elements,  and  contracting  each  combination  of  kinematic  joint  and 
connected  rigid-arm  elements  into  a  single  edge. 

To  generate  the  system  equations  using  a  graph-theoretic  approach,  a  tree  is  selected 
that  contains  elements  I  to  U,  with  the  torque  and  kinematic  joint  elements  placed  m 
the  cotree.  A  suitable  across  variable  is  the  position  vector  r ,  corresponding  to  element 
i  in  the  graph,  while  the  force  £,  in  this  element  is  identified  as  an  appropnale  tbrougn 


Fisur«  6:  Vector<Network  Gr&pb  of  Four*Bii  Meek4niim 
mitble.  For  each  pis  joint  element  hit  can  write  the  tennisal  equation: 


recognising  the  fact  that  the  two  pointi  (nodei)  connected  by  a  revolute  joint  remain 
coincident  for  any  posiible  motion  of  the  aystem.  With  this  terminal  equation,  the 
kinematic  constrrist  equations  can  be  systematically  generated  using  the  fundamental 
circuit  equations  (12)  for  the  cotree  pis  joints.  As  an  example,  the  circuit  equation 
conesponding  to  kinematic  joint  hu  (Pj)  is: 

tu  =  Ls  +  C*  -  El  -  tr  =  0  (42) 

The  eight  constraint  equations  (16)  and  (17)  are  obtained  by  resolving  the  vectorial 
circuit  equations  for  the  four  pin  joints  into  components  parallel  to  the  inertial  X  and 
Y  axes.  In  a  similar  systematic  fashion,  and  recognizing  the  fact  that  the  terminal 
equations  for  the  mus  elements  correspond  to  the  vectorial  NewtoS'Euler  equations, 
the  cutset  equations  for  these  tree  elements  result  in  nine  scalar  differential  equations 
in  which  the  reaction  forces  in  the  pin  joints  appeu  explicitly.  One  can  see  that,  as 
a  consequence  of  using  absolute  coordinates  to  represent  the  position  and  orientation 
of  each  mass  element,  the  final  set  of  DAEs  generated  by  the  vector*netirork  method 
corresponds  exactly  to  equations  (18)  and  (19). 

Using  an  analytical  substitution  procedure,  Li  (16]  has  reduced  this  set  of  DAEs 
to  the  smaller  set  corresponding  to  equations  (23)  and  (30).  More  recently,  Baau 
and  Kesavan  [31]  have  derived  tnese  latter  equations  directly  using  a  linear  graph 
model  similar  to  th»t  employed  by  Wittenburg,  relative  coordinates,  and  a  formal 


i 


cr^iDa'iheorQtic  appro&ch.  As  discussed  in  Section  2  demonstrated  above,  such  dn 
ionroacn  provides  a  systematic  formulation  procedure  in  wtucn  the  topoio^cai  equa¬ 
tions  are  dearly  distinguished  from  the  constitutive  equations  This  has  the  impor¬ 
tant  implication  that  new  types  of  mechanical  elements,  modelled  by  suitable  terminal 
equations,  can  be  incorporated  into  the  multibody  system  model  without  altering  the 
underlyirs  formulation  procedure  With  this  in  mind.  eiTorts  arc  currently  under¬ 
way  to  incorporate  nonholononuc  joints,  flexible  bodies,  and  vanable-mass  elements 
into  existing  veetor^network  formulations.  One  further  advantage  of  a  graph-theoretic 
approach  is  that  it  can  provide  a  single  unified  formulation  for  systems  contaimng 
elements  from  differeat  physical  regimes,  eg.  hydraulic,  pneumatic,  or  electromc  el¬ 
ements.  This  leads  the  author  to  be  optimistic  about  the  future  application  of  the 
vector-network  method  to  the  growing  field  of  mechatronics. 

6.  Conclusions 

To  develop  a  dynamic  formulation  that  is  applicable  to  general  multibody  svstems 
with  open  and  closed  loops,  some  means  of  representing  the  topology  of  the  system 
IS  required.  If  one  uses  absolute  coordinates  to  desenbe  the  location  of  bodies  in 
the  system,  the  topological  description  is  automatically  embedded  in  the  relatively 
large  set  of  DAEs.  If  one  uses  a  set  of  relative  (joint)  coordinates  however,  some 
form  of  topological  processing  is  requued  in  order  to  account  for  the  connectivity  of 
the  bodies.  To  represent  the  system  topology  and  to  generate  some  of  the  required 
kinematic  relationships,  several  reseuchers  have  made  use  of  linear  graphs  and  their 
assoaatefl  topologieil  matrices.  It  has  been  shown  that  many  of  these  kinematic 
relationships  are  equvilent  to  the  equations  obtained  from  a  formal  graph-theoretic 
approach.  The  advantages  of  using  such  an  approach  have  been  discussed,  and  the 
systematic  generation  of  the  governing  DAEs  using  the  vector-network  method  has 
been  described.  Research  is  underway  to  extend  this  graph-theoretical  method  to  the 
analysis  of  flexible  multibody  and  mecbatronic  systems. 
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ABSTRACT.  This  pipes  provides  a  speciBcaaon  of  a  relational  darabase  stnicttire  for  mechanical  systems 
Through  the  example  provided,  a  robot  gripping  device,  it  is  demonstraied  how  the  initial  development  of  the 
database  stnicnire  has  successfully  led  to  an  tmplenientanon  in  aprachcal  software  envirtximait.  The  darabase 
IS  accessible  to  mtilnple  engineering  applicauon  programs  aid  sirppons  a  flexible  environmeni  for  the  con- 
tiniimg  development  of  new  applicaoons 


1.  Introduction 

The  engioeenog  process  when  designiog  and  aunufaciiinng  mechanical  systems  is  now  gomg 
through  substannal  changes.  The  changes  are  mtended  to  shorten  development  tune,  to  improve 
quality  and  to  reduce  cost  of  products.  Speaaliaed  discipUnes  ace  integrated  m  a  sunultaneous  engi¬ 
neering  process  where  all  the  relevant  acnvmes  such  as  design,  analysis,  lesnng  and  maoufacmrmg 
are  involved  to  the  early  stages  of  the  development  of  the  product  The  benefit  of  this  techmque  is  the 
abUiiy  to  make  conect  decisions  in  the  early  stages  of  the  dcsip  of  a  product  This  of  course  reduces 
re-work,  improves  quality  and  saves  money  compared  widi  the  tradmooal  way  of  design  where  for 
example  simulanons  of  product  performance  were  earned  out  in  a  late  nage  of  the  product  develop¬ 
ment  nme  when  changes  are  expensive 

To  ease  engineeiing,  several  computer  aids  have  been  developed.  Impotiani  tools  are  programs 
for  Computer  Aided  Design  (CAD).  Ftmie  Qetnent  Analysis  (FEA).  Computer  Aided  Manufactur¬ 
ing  (CA^.  Miilnbody  System  Analysis  (MSA)  and  spemal  puipose  simulanons.  These  tools  can  be 
used  successfully  one  by  one  but  the  large  benefits  are  gamed  first  after  an  integranon  where  dau 
created  or  changed  in  one  appheanon  immediately  can  be  used  in  the  other  steps  of  the  development 
process.  For  example  it  should  be  possible  to  use  the  geometry  of  a  sohd  model,  already  defined  in  a 
CAD  program,  when  creanng  a  FE  model  or  geaeratmg  NC-code  m  a  CAM  program.  The  adnun- 
istranon  of  data  is  preferably  earned  out  with  the  produa  dau  stored  m  a  central  daubase  which  is 
possible  to  access  from  all  appbeanons.  see  Figure  I. 

In  this  paper  modem  daubase  techmques  are  demonstrated  in  the  analysis  and  design  of 
mechamsms.  In  paracular  the  generahty  and  the  easy  access  and  alteranon  of  the  dau  m  the  database 
system  are  considered.  The  paper  focuses  on  the  produa  database  and  espeaally  the  parts  which  are 
unportam  for  mulnbody  system  analysis.  See  Figure  2  where  'Simulanon  of  Performance'  from 
Figure  1  has  been  divided  into  'Stren^  of  Matenal"  and  'Mulnbody  System  Analysis'. 
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Figure  I  In/crmaaon  flco^  of  a  computer  aided  Jicnultareous  engineenng  av^tem 


Databases  for  Mechanical  Systems 


When  designiQg  mechanical  systems  u  for  example  vehicles,  robots  and  NC*macbines  an  important 
aspea  of  the  tuncooo  of  the  product  is  its  dyoamical  behaviour.  It  is  therefore  important  that  susu* 
laaoQ  and  an^ysis  software  for  tte  dynamical  behaviour  of  a  product  is  integrated  m  a  design  system. 
A  huge  QUfflb^  of  methods  and  soft  uvt  have  been  develops  which  allow  the  automanc  formula* 
aon  and  solviog  of  the  equaaoos  of  moocn  by  the  computer  for  many  types  of  mechanical  systems. 
Summanes  of  computer  codes  for  simulaohg  mulQbody  dynamics  are  given  in  (1)  and  (2).  The 
fflulDbody  systems  are  built  of  rigid  and/or  flexible  bo^es  with  inenia  and  springs,  dampers  and 
force  ^mators,  iptemonnected  by  joints,  rigid  beanogs  and  supports  Fricnon  forces,  cootaa  for  is 
and  cdnstraihts  may  also  be  included.  Informanon  about  these  components  can  be  included  in  the 
daubas^  ' 

If  mechanicil  S/Stems  are  to  be  stored  in  a  general  form  m  a  database  the  appropnate  and  sufficient 
mfonnanoo  a^t  the  mechamsm  has  to  be  defined.  The  data  of  the  mechanical  system  is  preferably 
defined  iode^dendy  of  the  formalism  applied  for  the  generasoo  of  equanons  of  moocn  and  are 
extracted  from  the  geometneal  desenpoon  of  the  system.  Since  newer  and  better  tools  are  developed 
rapidly  it  is  itnportant  that  the  design  engineers  are  able  to  change  computer  tools  whenever 
oecessuy.  To  make  the  design  system  robust  and  independent  of  the  specific  appbeanoo  programs, 
the  produa  daubase  should  be  independent  of  the  appficaaoru  winch  are  accessmg  it. 

Using  a  common  database  for  all  appbciaoa  programs  (codes)  also  reduces  the  number  of  re* 
quired  interfaces  between  programs.  The  effon  when  adding  a  new  appbeanon  is  then  subsianoiUy 
reduced  since  the  appbeanon  only  needs  to  commumcate  with  the  database. 

Using  the  geometry  dau  and  the  resulong  ome  histones  oi  *Jie  dynamical  behaviour  of  the  me* 
chanical  system,  the  monon  can  be  animated.  This  is  a  favourable  approach  for  debugging  of  the 
mathematical  model,  to  obtam  an  overall  idea  of  the  monon  and  for  pinpomong  specific  problems 
such  as  improper  connectivity,  misapplied  motions  or  forces,  unwanted  osciUatory  behaviour  and 
cleartcce  problems.  Therefore  the  geometry  (curves,  rurfacea  etc.)  should  also  be  easily  accessible 
from  the  database. 

2.1  .MECHANISM  DATABASE  STRUCTURE  AND  TABUS -AN  EXAMPLE 

The  demands  above  can  lead  to  the  database  structure  of  Figure  3.  In  this  database  structure,  a 
mechanism  is  defined  as  a  coUecuoo  of  ngid  bodies  that  can  move  relative  to  each  other,  with  joints 
that  Umit  relaove  monon  of  pain  of  bodies.  A  reference  triad  is  a  local  coordinate  system  that  con* 
sisis  of  an  ongin  and  three  axes,  x.  y  and  z.  Each  refdeoce  mad  is  anached  to  a  ngid  body  at  a 
selected  locanoo.  The  locaoon  and  onentanon  of  a  joint  are  defined  by  a  pair  of  reference  mads 
associated  with  two  ngid  bodies.  The  locanoQ  of  a  force  is  defined  by  a  reference  mad  Snffriesses 
and  dampings  between  ngid  bodies  are  defined  between  pairs  of  refffence  mads. 

The  monon  of  a  mechamsm  is  driven  by  toads.  The  loading  may  be  gravity,  applied  forces,  applied 
monon  and  tmoal  coodinons.  The  vananoos  of  applied  forces  and  applied  monoos  can  be  desenbed 
by  input  fimenoos.  The  geometry  of  each  ngid  b^y  is  defined  m  the  object  table  and  its  subtables. 
Observe  that  this  daubase  structure  is  flexible  and  can  be  changed  acccrding  to  the  user’s  desire. 

Tables  corresponding  to  the  daubase  structure  m  Figure  3  are  shown  m  Figure  4,  At  the  top  of  the 
ubles  the  able  name  are  located,  followed  by  the  column  names.  The  coupling  between  the  tables 
are  made  by  key  records  which  are  marited  with  lues.  The  different  ubles  coouin  recevds  of  the 
different  dmty^.  integer,  character,  real  and  double  precision. 


153 


Figure  3.  The  medunum  deubue  itnicture.  A  single  line  Ulutma  aooe  to  one  teliooiuliip.  for  example  liio 
geomeirg  of  one  ngid  body  is  descnbed  by  one  obgect  defisiuon.  A  fork  illusmes  t  one  to  several  relanoo- 
ships,  for  example  a  mechmsm  oonsisa  of  more  ihn  one  rigid  body. 

As  an  example  the  table  Joint  is  deaoibed  below.  The  descnpove  infonnabon  m  ibe  ’.ableyolnt  con¬ 
sists  of  SIX  tecotds.  joint  ja  is  an  integer  value  idenuiyuig  the  specific  poL  joint _nam  is  a  character 
string  containing  the  name  of  the  speafic  jottiL  refjriodJ  and  r^jriad_2  are  integer  values  pouit- 
log  at  the  two  reference  triads  m  the  rtf^^ad  table  assomated  with  the  joint.  Joint jvpe  is  an  integer 
value  descnbtng  which  type  of  jotm  it  isTexamplea  are  revoluis  joints  (1),  slider  joints  (2).  ball  joints 
(3),  cylindrical  joints  (4)  and  planar  joints  (3).  The  last  record  yrjuer Jlaf,  is  an  integer  flag  that  is 
reserved  ftr  user  specific  luformatioa 
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ESSENTIAL  CHAR-^CIERISTICS  OF  ENGINEERING  DATABASE  MANAGEMENT  SYSTEMS 


When  engineenog  daubase  management  systems  are  to  be  chosen,  some  essential  cbar^ctensncs 
have  to  be  considered  (3-7J. 

An  engm'eenng^diiabase  must  be  accessible  to  mulople  engineering  appbcauon  programs  and  it 
must  also  support  an  envtromnent  for  the  contmuing  development  of  new  applications.  Application 
programs  use  different  representations  of  the  same  objects  to  achieve  the  most  efficient  solution  to 
the  panicular  problem  they  am  designed  to  solve  This  impbes  that  the  database  schemes  must  be 
flexible  enough  to  support  mulople  views  of  the  dau  in  the  database  ais  well  as  modification  and 
extension  of  the  schemes.  The  manipulation  of  dau  must  include  the  operations  uisen.  delete  and 
query.  Dau  models  for  design  of  diabase  schemes  should  preferably  support  eogiDeenng  dau  types 
(yearn,  matnees  etc.)  and  the  complex  object  types  found  m  engineenng  appbca&ons. 

An  engineenog  database  system  should  provide  a  facibty  for  managing  imegnty  constraints  on  the 
database  and  should  automaocally  maiocain  a  coosisteoi  database  state.  The  control  of  consistency  of 
the  dau  should  be  included  in  the  appbeanons  orm  the  executive  of  the  system.  The  execunve  is  a 
command  processor  that  assembles  informaaoo.  launches  appUcanou  programs,  accumulates  per* 
fonnance  predienoos.  and  provides  control  over  the  process  ^  the  usr  13*3}. 

In  order  to  support  access  of  the  databav.  by  engineenng  appbeanow'  codes,  the  system 
must  have  a  host  langui^e  mterface  Because  of  the  amount  of  engineenog  computiog  that  is  done  in 
Fortran,  the  interface  should  include  access  for  at  least  this  language.  The  system  execunve  should 
use  query  languages  embedded  m  the  host  language  to  access  the  mformanon  m  the  daubase.  Sun* 
dard  query  languages  factlitate  the  extracuoo  of  inforaiQCo  even  for  a  none  expen.  All  types  of  dau 
(admimsffaave.  mechanical  etc.)  should  be  available  with  the  same  quer^  language. 

A  product  development  system  requires  a  system  executive  that  controls  the  execunon  of  appb* 
cation  programs  a  daubase  management  system,  user  interfaces,  suppott  uuiioes.  oetworiang 
capabtUoes  and  distributed  compunog.  Ihe  executive  systets  must  support  mulople  and  coxuireot 
users,  who  may  operate  either  is  batch  mode  or  interactively. 

The  daubase  system  should  not  unpose  constraints  os  a  preferred  sequence  of  acovioes  to  the 
design  piocess.  Concurrent  usen  must  have  access  to  the  system  simultaneously  mdepeodently  of 
their  acovioes.  This  is  one  of  the  foundaooos  of  simuluoeous  engineenng  [8]. 

2  3  THE  CHOSEN  SYSTEM  SOLUTION 

Our  soluoon  to  the  demands  above  is  to  develop  the  database  using  the  relaoooal  database  manage* 
meat  system  called  INFORMIX  [9.10].  The  flexibUity  of  the  relaocoal  dau  mode!  is  the  imponani 
property  making  it  adapublc  to  the  needs  of  eagioeenng  database  management  (4).  INFORMIX 
consists  of  useful  programs  or  modules  that  perform  dau  management  tasks.  The  mampuliooo  of  the 
dau  IS  performed  usmg  the  standard  high  level  languages  SQL  and  4GL  HO).  INFORMIX  supports 
distributed  procesaog  which  allows  users  across  the  uetwock  to  easily  access  the  same  database 

The  daubase  structure  desenbed  in  Figure  3  and  4  has  been  unplemeoted  in  the  chosen  relanonal 
database  management  system  as  pan  of  a  software  development  projea  earned  out  at  the  Division 
of  Computer  Aided  Design  at  Lulei  University  of  Technology.  Sweden. 

The  handling  of  consistency  maintenaucc  can  be  divided  into  two  paru.  First  there  is  consistency 
check  when  inserting  dau  into  the  daubase  Records  that  must  have  a  value  are  not  allowed  to  be 
null.  For  example  a  jomt  must  have  a  joint  number,  two  reference  tnids  and  a  joint  type  If  a  non* 
consistency  sh^d  occur  it  is  eliimnated  through  an  adsumstraove  funenoo  that  deletes  all  tnfor* 
mason  with  non*valid  relanoos 

The  communicasoo  between  the  database,  the  applicasons  and  the  user  lote^ace  are  taken  care  of 
and  controlled  by  a  centul  execunve 


3.  Example '  a  Robot  Gripp.;ii$  Device 


The  following  example  lUusiraies  how  the  proposed  system  operates  when  processing  a  typical  me« 
chamcal  system.  Consider  the  development  of  a  gripping  <bvicc  for  a  robot  The  funcnon  of  the 
device  is  to  gnp  and  Lift  a  cylmder  with  a  diameter  of  30  mm  and  a  mass  of  3  kg.  see  Figure  6.  The 
first  stage  is  to  ideanfy  the  geometry  of  the  individual  pat»  to  the  mechamsm.  This  can  be  done  m 
any  suitable  CAE  system  We  have  chosen  to  define  me  snppiog  device  using  the  program  I*DEAS 
bySDRCdU. 


Figure  6  A  robot  with  a  gripping  device 


Fipire7  ■fiM  robot  gnppuij  deviet 

Tlie  gnppmg  device  sbown  m  Figure  7  coosiits  of  six  objects.  Tlie  objects  >re  modeled  and  tbeir 
cotrespoadiog  physical  charaoensacs  ate  defined.  Then  the  device  is  t.'emhied  and  ns  jotois.  ap¬ 
plied  monoa  aad  applied  forces  are  added  to  the  system.  The  bodies  are  connected  by  seven  joints. 
Joint  number  one  is  a  sllda  joint  between  PISTON  and  HOUSING  and  the  six  other  joints  are  rev¬ 
olute  joints  connecung  GRIPPINO.LEVERI  with  COUPLERl.  GRIPPING.LEVER1  with 
HOUSING.  COUPLERl  with  PISTON,  COUPLER2  with  PISTON.  ORIPPING.LEVER2  with 
HOUSING  and  finally  COUP1.ER2  with  GR1PPINOJLEVER2.  Here,  the  piston  is  forced  by  an 
applied  motion  which  is  proporacoal  to  tune.  When  the  mechanism  is  defined  the  analysis  can  be 
made  usuig  different  computer  codes,  depending  on  the  specific  tasks.  In  this  example  the  task  may 
be  to  make  sure  that  no  pans  are  uuerfenog,  that  the  main  funcnon  is  fiilfilled  i.e..  gnppmg  a  }0  mm 
cylinder  and  thu  the  design  will  have  enough  strength. 

To  be  able  to  miVe  the  analysis  m  any  suitable  software  the  necessary  information  of  the  meeba- 
msm  IS  transfened  to  the  neunal  format  desenbed  in  Figure  3  and  Figure  4.  This  is  done  by  leadmg 
from  the  relanonal  database  PEARL  within  the  I-DEAS  system  to  the  mechanism  database  devel¬ 
oped  in  INFOR.MIX  as  desenbed  above  Examples  on  data  in  the  tables  m  the  produa  dambase  for 
this  mechamsm  are  shown  in  Figure  8.  The  applicanon  programs  may  extract  the  suitable  informa- 
non  from  the  database  usmg  the  query  language.  The  mterfaces  can  now  be  wntten  m  embedded 
Fortran  or  4GL  [10]  for  automauc  transfer  of  the  dim  to  a  suitable  format  for  the  appheanon 
program. 
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4  Discussion  and  Conclusions 


Simultaneous  eogineenog  demands  a  full  mtegranon  of  eogineenng  computer  tools.  The  mtegracon 
IS  preferably  earned  out  with  the  product  dau  stored  to  a  central  database,  a  system  execuove  that 
controls  the  execution  of  applicanm  programs,  a  database  management  system,  usa  interfaces,  sup* 
pon  uttlines.  networking  capabdioes  and  distributed  compunng. 

The  product  data  of  a  mecbaiucai  system  is  prefendily  defined  independently  of  the  formalism 
applied  for  the  generanon  of  equauons  of  moaon  and  are  extracted  from  the  geometneal  desenpnon 
of  the  system.  Since  newer  and  better  tools  are  developed  rapidly  it  is  important  that  the  design 
engineers  are  able  to  change  computer  tools  when  necessary.  To  make  the  dttigo  system  robust  and 
mdependeot  of  the  specific  programs,  the  product  database  should  be  ^  ndependent  of  the  applicanoos 
accessing 't  Using  a  common  database  for  all  applicanoo  programs  also  reduces  the  number  of 
required  interfaces  between  programs.  The  effort  when  adding  a  new  applicanoo  is  tlien  substannaUy 
reduced  since  the  new  apphcaoon  only  needs  to  commumcate  with  the  daubase. 

This  p^>er  provides  a  speaficanoo  of  a  relad^tal  database  smicniie  for  mechamcal  systems. 
Through  the  example  provided,  udemonsinus  bow  the  initial  development  of  the  smicnire 

has  successfully  led  to  an  implementanoo  m  a  practical  software  eovvoomeoL  The  <i*t*h*^  is  ac* 
cessible  to  mulnple  eogmeenog  application  programs  and  support  a  flexible  environment  for  the 
cononuing  development  of  new  applicanoos. 
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abstract  We  propose  a  simple  method  for  the  lineanzauon  of  the  nonlinear  dynamic  equations. 
vi.hich  are  established  in  our  case  based  on  the  Kane's  virtual  work  principle.  The  system  generalized 
variables  used  in  ^e  equauons  are  the  reference  coordin^  at  the  connections  for  the  ngid  body  motions 
and  the  time  denvauves  of  the  body  modal  coordinates  for  the  flexible  body  behaviors  In  the  lineanzation 
process,  the  pamal  denvauons  of  the  kinematic  terms  with  respect  to  the  generalized  coordinates  and  to  the 
generalized  velocities  have  to  be  performed  In  our  method,  th^  pamal  denvauves  are  yielded  through  the 
first  and  second  order  time  denvauons  of  the  body  rotauonai  absolute  angular  velociues  and  through  the 
first,  second,  and  third  order  ume  denvauons  of  the  mass  center  vectors,  respecuvely.  This  .s  the  key  point 
of  our  method.  The  parual  denvation  of  the  mechamcai  terms,  e  g .  of  the  memal  tensors  etc .  are  also 
calculated  We  have  developped  the  specific  operators  to  perform  the  time  derivations  without 
disungutshing  the  ngid  and  flexible  variables.  Tlus  method  makes  both  the  theoreucal  deducuon  and  the 
programming  relatively  simple,  and  allows  a  rapid  compuung. 


1.  Introduction 

Many  mechanical  and  structural  systems  such  as  vehicules.  manipulators  and  aircrafts, 
consist  ot  interconnected  components  that  undergo  large  rotauons.  The  charactcnsiic  of 
iuch  flexible  mulubody  systems  is  the  high  degree  of  nonlineaniy  of  ns  dynamics.  An 
accurate  mathemaucal  model  for  these  systems  has  to  account  for  menial,  centrifugal,  and 
Conolis  nonlincanucs  due  to  large  body  motion.  The  tendency,  especially  in  aircraft  and 
robotic  industncs.  to  produce  systems  with  lightweight  components  that  operate  at  very 
high  speeds  enhances  the  demand  for  such  accurate  maibcmatical  models  These  systems 
incori^rate  various  types  of  driving,  sensmg,  and  controlling  devices  working  together  to 
achieve  specified  performance  rcquircmcnis.  However,  many  of  these  systems  exhibit 
senous  vibrauons  that  cause  damage  to  the  system  components,  at  least  a  deviauon  from  a 
requircv^  performance.  The  dynamic  analysis  and  control  design  of  these  nonlincr  systems 
are  thus  important,  which  is  however  complicated  due  to  the  coupling  between  the 
nonlinear  ngid  body  motions  and  the  linear  elastic  displacements  of  the  body  dunng  the 
motion.  In  general,  the  behaviours  of  such  systems  can  be  accurately  reproduced  by  the 
nonlinear  dynamic  equations.  It  is  also  possible  to  use  the  nonlinear  dynamic  mode)  as  the 
core  of  a  control  algonihm  but  it  is  very  expensive  in  computing  (1. 2).  Thus  a  Imcar 
dynamic  model  for  the  nonlinear  system  is  usually  required  in  order  to  simplfy  (he 
computing  and  to  adapt  to  the  control  design  which  has  been  developped  for  the  linear 


systems  and  already  exists  as  well  as  modal  analysts.  Obviously  to  reach  this  purpose,  the 
lineanzation  procedure  is  necessary  to  be  perfoimed 

In  this  paper,  we  propose  a  simple  linearization  method  to  obtain  the  linear  dynamic 
model  for  i  flexible  multibody  nonlinear  system  Our  nonlinear  dynamic  equations  for  the 
system  are  established  using  the  Kane's  vinual  work  principle.  Elastic  bodies  in  the 
system  are  discretized  using  the  finite  element  approach.  Their  deformation  modes  are 
directly  denved  from  the  differential  equations  with  appropnate  boundary  conditions.  A 
finite  element  code  can  be  used  for  this  calculation  (e.g..The  Nastran  or  Systus 
softwarel.The  configuration  of  each  elastic  body  is  defined  by  using  a  set  of  absoiute 
coordinates  and  modal  coordinates.  The  kinemauc  relations  between  the  interconnected 
bodies  arc  represented  by  the  recusive  equations  (3).  Obviously,  a  direct  partial  derivation 
of  these  nonlinear  dynamic  equauons  in  the  lineanzation  procedure  can  generate  a  large 
amount  of  terms,  due  to  the  strong  coupling  and  nonlinear  relationships  among  the 
vanables,  which  can  hardiy  be  bandied  m  the  progmmming,  especially  on  ^rforming  the 
panial  dertvauons  of  kinematic  terms  with  respiret  to  the  generalized  coordmates  in  order  to 
establish  the  stiffness  matnx  of  the  lineanzed  system.  The  denvalion  process  is  thus 
overwhelming. 

However,  we  can  in  fact  obtain  these  partial  dcnvatives  through  the  first  and  second 
order  time  derivations  of  the  body  absolute  angular  velocities  and  through  the  first, 
second,  and  third  order  time  denvations  of  the  mass  center  vectors,  respectively,  so  that 
the  linearization  procedure  can  be  very  much  simplified.  We  have  developed  the  specific 
operators  to  perform  the  time  denvatives  without  distinguishing  the  ngid  and  flexible 
vanables.  We  Idee  to  desenbe  our  nonlinear  elastic  model  in  Section  2,  to  introduce  our 
lineanzauon  procedure  in  Secuon  3,  to  present  our  secuence  of  computation  in  Section  •» 
and  to  give  a  numer.cal  example  in  Secuon  5.  We  conclude  in  Secuon  6. 


2.  System  Dynamic  Equations  of  Motion 


The  Kane's  vimial  work  pnnciple  (4, 3)  states  that  the  sum  of  the  virtual  works  of  elastic 
forces,  of  active  forces  and  of  inerua  forces  is  equal  to  zero,  all  of  which  are  acting  on  the 
system.  Note  that  the  non-working  interconnected  constramt  forces  between  the  bodies  of 
itie  system  are  elumnaud  in  usmg  this  pnnciple.  The  pnnciple  can  be  expressed  as: 


loSEfdv-jFSrdS+jrfSrdMsO.  ,i) 

V  IS  the  volume  of  the  body  k  in  the  deformed  swte.  6r  is  the  kinemaucally  admissible 
vimiel  displacement  of  a  point  in  the  body,  r  the  acceleration  of  the  point.  F  the  external 
force  and  the  body  force,  and  a  and  e  represent  the  stress  and  strain  tensors.  In 
correspondence  to  Eqn  (1).  the  pnnciple  can  also  be  wntten  as. 

8w‘“‘  -  Swe*'  +  5w'“'  =  0  m 

Among  the  three  terms,  the  vinual  work  of  the  menial  force  is  the  most  delicate  and 
complicate  to  develop.  In  the  following,  we  give  in  some  details  the  development  of  this 
term  and  only  a  bnef  menuon  of  the  two  other  terms. 
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2.1  GEMERAUZED  INERTIAL  FORCES 

We  first  develope  the  virtual  work  of  meiual  forces. 

Sw"’'=  |r8rdM 
M 


Figure  1  shows  the  undefortned  (shadowed)  and  deformed  states  of  a  flexible  body  k.  r 
and  a  are  the  position  vector  of  an  arbitary  point  M  on  the  deformable  body  and  the 
position  vector  of  the  mass  center.  X  is  the  vectors  from  the  mass  center  (Gd)  to  an 
arbitrary  point  M  on  the  deformed  body  and  Y  is  the  vector  from  the  mass  center  (Go)  to  an 
arbitrary  point  Mo  on  the  undefoimed  body.  The  following  formulation  uses  an  inertial 
reference  frame  (Ro)  to  descnbe  the  translation  mouon  and  a  body-fixed  frame  (Rj)  for  the 
rotattonal  motion. 


Fig.  1.  Deformed  (shadowed)  and  undeformed  states  of  the  flexible  body. 
The  position  of  the  pomt  M  on  the  deformable  body  can  be  wntten  as- 


r  =  a  +  X 

X  =  Y  +  (U(M)-  U(G)) 


(3) 


n  n 

U(M>=  25a«o(M)  and  U(G)=  I5a«a(C). 

aa|  oal 

n  IS  the  number  of  modes  for  the  defonncd  body  l>a  the  vector  of  the  vibration  shape 
and  4a  is  the  modal  coordinates. 
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Denvaung  Eqn  (3)  with  respect  to  time  yields 


r  =  a  +  (0AX  +  .'? 
i  =  t}(M)  -6(G), 


(4) 


m  which  CO  IS  the  absolute  angular  velocity  vector  of  the  body  k  and  X  the  ume  denvative  in 
the  body  reference  R<). 

The  acceleration  of  the  point  M  can  be  determined  by  the  direct  derivation  of  Eqn. (4), 
which  IS 


r  =  a  +  eOAX  +  COA((OAX)+2(OA5  +  ? 
?6=tf(M)-t?(G) 


(5) 


The  virtual  deplacements  of  the  pomt  M  is 

Sr  =  8a  +  8x  =  8a  +  So  A  X  +  8?a(<<'a(M)  -  d>a<C))  (6) 

in  which  M  IS  the  virtual  angular  deplacement  of  the  body  k.  Thus 


8a  =  V/8q(  +  Voi85a  =  v|8p)T 

(a  =  1, 2, ...  n/) 

(7) 

89  =  n/8q/  +naS5a  =  0(8p)T 

(/=l,2.  ...Or) 

(S) 

V  =  (Vi  .  Vo),  a  =  (fli  ,fla).  and  |8p)T=  (Sqj.S^o)''' 

nr  IS  the  number  of  the  ngid  degree  of  freedom  (DOF),  n/is  the  number  of  the  flexible 
DOF.  q;  IS  the  relauve  jomt  cootinates  for  the  ngid  body  motion.  The  vectors  V  and  n  are 
the  panial  velocity  and  the  partial  angular  velocity  of  the  body  k  which  are  all  the 
complicated  implicit  functions  of  p.  Their  recusive  expressions  are  given  in  detail  in  (3) 

We  thus  have  obtamed  the  generahzed  ineitial  forces  for  the  body  k  associated  with  Sqi 
and  8^: 

Fi*  =  •  V(M  a-  O/lJci)  +(1)A  Jca  +  K(i)4-l‘aHa)  (9) 

Fa*=  -  Vo  M  a-  na(Jti>  +03  A  10)  +  K<1)  +  (oHol 
n 

•(HoO)  -  CO-JoCO+AaO)  +  |la?o-  S  M<t»o(C)<I>p(G)'4(} ) ,  (10) 


m  which 

CO  s  Q  p. 

i\l) 

a  =  V  p. 

iiZ) 

0)  a  a  p  +  n  p. 

(131 

a  a  V  p  +  V  *p. 

(141 

and  M  IS  the  mass  of  the  body  k.  We  call  Ha.  J,  K.  Jo,  Ho,  and  Ho  are  the  mechanical 
tensor  terms  of  the  deformed  body  whose  defimuons  can  be  found  m  Appendix. 

2.2  GENERAUZED  ELASTIC  AND  EXTERNAL  FORCES 

The  vutual  work  due  to  the  elastic  forces  can  be  wntten  as. 

Sw'iit  =  -  I  o8eTdv  = .  5a^K<,aS?o. 


Koo  IS  the  symmetrical  positive  dermite  stiffness  matnx  associated  with  the  elastic  model 
coordinates  of  the  body  k  m  the  mulabody  system.  The  matnx  Koo  is  very  easy  to  be 
obtained  by  the  fuute  -element  method. 

The  virtual  work  of  all  the  external  forces  actmg  on  the  body  k  can  be  also  wntten  as: 


5w««=  |FSrdS=(Q|T(5pl, 


where  IQlT  is  the  vector  of  the  generalized  force  m  function  of  the  generalized  coordinates 
2  3  GENERAL  FORM  OF  THE  DYNAMIC  EQUATION 

We  have  developed  the  generalized  forces.  The  dynamic  equation  for  the  flexible 
inulubody  system  can  thus  be  obtained  by  summing  up  the  contnbuuons  of  the  generalized 
forces  to  Eqn.(  I )  over  all  the  bodies.  The  general  form  of  the  equauon  is  wnnen  as; 

M(p)p +B(p.p)-i-g(p)-Fdp  ■Fkp  =  T,  (13) 

in  which.  M(p)  IS  the  system  mass  matru, 

B(p  .p)  IS  the  vector  of  the  Conolis  and  centnfiigal  forces. 
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g(p)  IS  the  vector  of  the  gravitanonal  force. 

d  IS  the  system  damping  matrix. 

k  IS  the  system  stiffness  matnx. 

and  T  is  the  vector  of  the  torques  acung  on  the  joints 

It  IS  evident  that  the  dynamic  equation  for  the  flexible  multibody  system  is  nonlinear  due 
to  the  strong  coupling  between  the  nonlinear  rigid  body  motions  and  the  linear  elastic 
displacements  of  the  body  In  order  to  modal  analyze  and' to  control  design  such  a  svsiem. 
we  need  to  perform  the  lineanzauon  of  Eqn.(  15). 


3.  Linearization  of  the  Dynamic  Equation 


Linearizing  Eqn,(  IS)  about  a  point  (po,  Po.  To)  yields  a  linear  equauon  as  wntten  below 


M(Po)  P+  D(Po.Po)  i)  +  K(Po.  Po)P  =  T 


(16) 


in  which  D  (=  d  +  5B/5p)  is  the  damping  matnx  and  K  (=  k  +  dsldp  +  8g/dp)  the  stiffness 
matnx  for  the  linearized  system.  The  linearization  of  Eqn.dS)  consists  therefore  in 
compuung  the  matnces  M.  K,  and  D. 

It  IS  necessary  to  perform  the  panial  denvation  for  each  temi  in  B  m  Eqn  (IS)  with 
tespect  to  p  and  p.  to  establish  the  damping  and  stiffness  matnces  for  the  linearized 
system.  Note  that  the  generalized  inerual  force  terms  which  contain  p  and  p.  as  shown  in 
Eqn  (9)  and  (10),  consist  in  the  major  pan  of  the  B  vector.  We  rewnte  these  terms  belowi 


b(=  V/M  aP  +  flj  (JOP  +  COA  J(0  + KO)}  (17) 

h«  =  VaM  aP  +  flaltpi’ +  (flo<P  ltd) +  DaKO>  + HaO)P-li)-JatO  +  liatd  |18) 


in  which  aP  =  vp  and  o)P  =  np. 

In  order  to  obtain  (Obj/Opj),  (3ba/3py),  (dbj/jpj ),  and  (BbafOp^ ),  we  need  both  the  p^  and 
P;  denvatives  of  the  kmemauc  quanuties  such  as  aP.  d)P.  6).  V.  R  and  the  p^  denvalives  of 
the  mechamcal  quantiues  such  as  I,  K,  Ja,  Ha.  and  Aa  to  obtain  the  pj  and  pj  denvatives  of 
bj  and  ba.  However  the  direct  paiual  denvauons  of  aP.  d>P.  u>,  V,  and  R  with  respect  to  p 
and  p  are  very  long  so  that  a  large  amount  of  terms  is  yielded  which  can  hardly  be  handled 
in  the  programing.  The  complication  mainly  results  from  the  denvations  of  the  kinematic 
quantities.  Thus,  we  introduce  a  simple  method  to  fuUfill  these  denvauons 

Let  us  wnte  down  the  rust,  second,  and  thud  order  time  denvauons  for  the  mass  center 
sectors  of  the  body  k  They  are  all  the  imphcit  flincuons  of  p  while  the  explicit  functions  of 

p.  as  wnuen  below 


a<  =  A,(p)  p, 


at  =  B,y(p)p,p;  +  c,(p)p, 

a*=  DyS(p)p,P;Pt  +  E,j(p)p,P;  +  F,(p)p, 


(1  =  1 

2 

N) 

il9) 

</=  1 

.  2, 

N) 

(201 

(k=  1 

2^ 

N) 

cn 

m  which  A,(p)  =  C,(p)  =  F.(p>.  N  (=n+nr)  is  the  total  number  of  the  genetalizeh  coordinates 
of  the  system.  A;,  B,,,  C,.  D,jic,  E,/,  and  F;  are  the  coefficient  vectors,  among  which  B,j(p) 
and  Di;t(p)  resulted  from  the  partial  derivations  of  the  mass  center  vectors  with  respect  to 
Pi,  py,  and  p*  Accotdmg  to  the  alternate  property  of  the  partial  differenti  ion.  we  have; 


B„(p)  =  By,(p) 

Dytlp)  =  D;fi(p)  =  Oh/.p)  =  Di*/P)  =  0;,t(p)  =  Dt;,(p). 


Similarly  the  first  and  second  time  denvauves  for  the  absolute  angular  vtijciues  are. 

®f  =  A,(p)p(  (23) 

d)F  =  B,y<p)p,py  +  C,(p)P(  (24) 

=Diyf(p)PiP/pf  +  E(p),;P,Py  +  F,<p)p (25) 


m  which,  Ai(p)  =  Clip)  =  F|(p).  The  Bi/p)  and  Di;»(p)  vectors  have  the  similar  relations 
iEqn.(22)),  Comparing  Eqn.(l9),  (20).  (23),  and  (24)  with  Eqn.(ll).  (12).  (13),  and  (14), 
respecuvely.  we  obtain: 

V,  =  A,(p), 


V,  =  B;,(p)p;, 


fli  =  A|(p).  and 
fli  =  Bi/P)Pr 


Our  idea  of  simplification  of  the  linearization  procedure  is  to  mahe  use  of  these 
coefficient  vectors.  We  memonze  these  vectoK,  among  which  the  B|/p)  and  Dyi(p) 
vectors  which  satisfy  the  relations  given  by  Eqn  (22)  are  sumed  up  and  put  into  the  B,y<p) 
and  Di;i<p)  vectors  for  which  i>j>k.  The  p  and  p  denvauves  of  the  kinemauc  teims  can  be 
formed  by  t-hese  coefficient  vectors  times  the  correspondmg  combmauon  of  the  generalized 
velocities.  The  followmg  formulae  are  established  in  such  a  way: 


(17) 


-  =  Z  8il(p)p,  +  2Bjit<p)pt+  S  B,t(p)p, 

dpj  '•!  '“k+l 


3aP 

r;—  = - =  Dui(p)ptpt  +?( I  Du,(p)  <•  I  D,tt(F'lPiPJ; 

m  3pj  ^  ,.i  ,-M 

1  k-l  1  N  k-1  N  N 

+  T(2  lDti/p)+  £  lD,j/p)+  I  IDyi(p))p,p; 

”  I*!  j*l  l•k+lj■l  jsk4-tt»j 


Note  ihai  the  p  denvativc  of  2P  is  obiaincd  by  the  p  der’  ,i»vc  of  iP,  whicT  makes  the 

denvauon  easier  because  a  is  the  explicit  function  of  r.  xi  mentioned  earlier  The  fractions 
in  (he  third  equation  are  *'esul(ed  from  such  an  indirect  dt  iivauon 


j^i,k(P) 

3ay>  k'l  -  -  . 

—  =  I  B,t<p)p,  +  2B«(p)pt  +  I  B,t<p)p. 

3pj  i"l  ••k*l 

3Ci)  k-i .  -  N  - 

- =  £  B,t(p)p,  +  2Bn<p)pt  +  I  B,t(p)p, 

3pi  '•< 

3aj  -  ,  , 

—  =  A*(p) 


^(iiP  3(0^  -  2  ^  “ 

3r7"= - =  D«i(p)piPk  +:;( I  Dn.(p))  *  z  Diu(p)IPiPt 

‘'Pk  3pj  ■»  >.|  I.k*l 

1  k-1  1  _  k-1  S  .  N  N  _ 

+  jl  Z  £  D»ij<P)  +  Z  Z  Dit/p)  +  Z  Z  l>i;k(P)iPiP; 

>«1  |«l  js|  i>k4-t 


(29) 

(30) 


(31) 


(32) 


(33) 


To  sum  up,  all  the  p  and  p  denvatives  of  the  kinematic  terms  can  be  obtained  by  simply 
performing  the  time  derivations  for  the  mass  center  vectors  and  the  absolute  angular 
velocities  instead  of  by  performing  a  complicated  direct  denvaiion.  In  order  to  calculate 


f 


quickly  the  time  derivation,  we  try  to  formulate  the  recurrent  relationships  among  the 
bodies  regarding  to  the  mass  center  vectors  and  the  absolute  angular  velocities 

3  1  RECURRENCE  EXPRESSION  OF  THE  ANGULAR  VELOCITIES 
.AND  THEK  DERIVATIONS  WITH  RESPECT  TO  TIME 

In  our  recurrence  expressions,  we  do  not  specify  the  generalized  coordinates  of  the  rigid 
and  flexible  bodies  by  using  different  notations.  We  simply  use  p,  ti=  1  :  N  Tto 
coordinate  the  bodies.  Thus  we  tabled  the  system  m  the  way  as  described  in  Fig.  2 
The  connecting  points  in  the  system  are  also  labled  as  the  bodies.  The  vector  Bn./  at  the 
connecting  points  represents  the  rotational  direction  of  the  ngid  body  in  the  system  The 
vector  on  each  body  represents  the  rotauonal  direction  of  the  deformed  body.  Thus  the 
absolute  angular  velocity  of  any  body  in  the  system  can  be  expressed  as; 


(Of  =  Olt-l  +  Prt-/),o  0rt-/).a 


(M) 


Note  that  a  now  represents  the  number  of  the  ngid  or  flexible  DOF,  Derivating  Eqn.  i34), 
we  can  obtain: 


01*  =  +  (Oi.i  A  (P(k-l).a^(k-l).a>  *  Pfl;-/;.o®rt./).o 

(lik  =  (Hk-i  +  Wf.i  A  (pif.i),o«rt-/i.a)  +  Of./ A((«./  A(pu./),a9f*.;Aa)) 
+  2(0i./  A  (pf*./t,o9n.Ii.a)  +  Prt.;i.o9f*-/l.o 


(35) 


(36) 


3  2  RECLTJRENCE  EXPRESSION  OF  THE  MASS  CENTER  VECTORS 
AND  THEIR  DERIVATIONS  .VITH  RESPECT  1 0  TIME 


Wc  consider  the 
state  (shadowed) 


two  connected  bodies  m  system  is  shown  in  Fig  3.  wnere  ihe  deformed 
and  undeformed  state  are  presented. 


Fig.  3,  The  position  of  the  mass  center. 
The  position  of  the  mass  center  of  the  body  is 

=  ajt.i  +  Sjp.j  +  rjt, 

in  which 


S2*.2  =  S'‘:k.2  +  i,(2i.2).a^ak-2l.a 

<■24  =  r°2i  +  i2k.a^lk.a 

^(2k-2l.a  =  *(2k-2).a  (R24-2)  -  ‘»(2k-2).a('02k-2) 
>•24.0  =  <»24.a  (02k)  ■  «24.a(Q24)- 


r”  and  r  Me  the  vectors  from  a  connecting  point  to  a  mass  center,  and.  5°  and  s  are  the 
vectors  from  a  mass  center  to  a  connecting  point,  respectively  before  and  after  the 

I'fe  folfovvmgo^^  J,^ 


D/(p)  =  G)tA(  ) 


(38) 


•  “TA 


D:*(p.p)  =(0t  A  (  )  +  tot  A  (<1)»  A  (  )) 


D,/(p.  p.  p  )=Mt  A  (•)  +  2  tO«  A  (cot  A  ( ))  +  cot  A  ((»t  A  (  ))  +  to*  A  (COt  A  (COt  A  I  )))  1-<01 
The  time  denvations  of  a  using  the  operators  are: 


a2t  =a2/i-2  +  D; +  i,(2t-i)-a  -(ik-D.a  +  C>/^*(p)r2t  +  ^^t.a  Xft.o 


aj*  =  ajt.J  +  D2’*'^(p.p)S;t.2  +  2D/^*‘^(p)(?rjt  2),a  V2*-2).a) 

■Kf2t-2).a  >^2t.2).a  +  D2"(p,p)r2t+  2D;^*(p)(^2i,a  \2k.a)  +  52t.a  >-2t  a  (JJ) 
'hk  =  ajt.j  *  Dj-‘’^(p.p.p)S2t.j  +  3D2**'^(p.p)(^2t.2ta  ^2*  2), a) 


+  3D/"'^(p)(^jt.2).a  V2t.2Ao)  +  i(2k.2i.(r  V.  -2.  a+  Dj"(p.p.  p)r2t 


+  3D2*’*(p.p)(42t,a  Xjt.o)  +  3D/^*(p )( ^jt  a *i2k.a 


We  have  obtamed  the  recuurence  expressiors  and  'he.  operators  to  caiculate  the  high  order 
time  denvations  of  the  angular  veloeittes  and  of  the  positio.-s  of  the  mass  center.  The 
denvations  of  the  mechanical  tensor  tenK  aath  resoec.'  f  the  feneraltzed  coordinates  are 
given  m  Appendix.  In  the  following,  we  give  a  bne^  about  our  p-ogramming 


4.  Sequence  of  Computation 


4  1  DEFINATION  OF  THE  POSITION  a'NCnON 


The  following  relauonships  allow  to  find  the  position  of  the  corresponding  coefficnnt 
vector  in  one  dimension  vector  array  for  the  g:i  cn  subscripts  (s  g ,  i  and  j.  or  i.  j.  and  k). 
We  call  these  relationships  the  posiuon  funenoas; 

alForpiP;,  Lcx:i(i.j>  =  ^i-l)i+j  0=^) 

b)Forp,p;pt,  LOC2(i.j.lc)  =  j(k-i;Mk+l)+  ^t-Di+j  (k2i>j) 


c)  For  pipy,  LOC3,Kj.j)=j0'2)”*'2i 

i.OC3J{i.  j)  s  i(i  -  2)  +  2j  +1 


Relations  between  the  positions  of  coefficients  and  the  combinations  ot  the  time 
denvatives  of  the  generalized  coordinates  are  given  in  Table 


Table  I  Correspondences  between  the  positions  of  coetficients  and  the  combinations  of  the 
time  denvauves  of  the  generalized  coordinates _ 


a 

P; 

p; 

P2 

Pi 

Pi 

PI 

Position  function 

(m) 

A,(p) 

a/ 

32 

ai 

a/ 

position 

/ 

2 

i 

4 

/ 

P<P; 

p;P/ 

P2P/ 

P2P2 

pip/  •  • 

p/p/ 

B;; 

B2/ 

822 

Bi/  ..  . 

B/; 

a 

position 

/ 

2 

2 

4 

1 

LOCI 

((0) 

pj 

P/ 

P2 

Pi 

pt 

PI 

c,(p) 

C; 

Q 

Ci 

Ci 

Cl 

position 

/ 

2 

2 

4  . 

1 

P.P;i>* 

p/p/ PI 

P2P/P/ 

P2P2P/ 

p/p/  p/  . 

PIPIPI 

D,;t<p) 

O/ll 

D2// 

022/ 

0222 

Out 

position 

1 

2 

2 

4 

I 

LOC2 

a 

pip; 

p/p/ 

P2PI 

P/P2 

P2P2  .  ..  . 

p/p/ 

(£0) 

E,;<p) 

E;/ 

E2/ 

E;2 

E22  . 

E// 

position 

I 

2 

2 

4  . 

/ 

1  OC3.1  and  LOC3.2 

P; 

PI 

P2 

Pi 

Pi 

PI 

F,(p) 

Pi 

F2 

Fi 

Fi 

Pi 

position 

/ 

2 

2 

4 

i 

4  2  CALCULATIONS  OF  THE  OPERATORS 

In  order  to  save  the  calculation  time,  we  successively  apply  the  recurrence  expressions  to 
the  terms  in  the  operators. 

=  CO*  A  (Wi  A  e,)  =  A,^  f+Ujt.iA  (0)t.;ACj)+  (Ot./  A  (U*./A  C,)+Ujt./A  (O^./A  Cj) 

-  CO*  A  (COjt  A  C,)  =  +  (0)*./  A  0*./)  A  (©*,/  A  C,)  +  Ut./A  (©t-/  A  C,) 

+  ©t-/  A  (Ufc./  A  e,)  +  <Wt./  A  U*./)  A  (Cm  a  C,)  +  Ut./A  (Ujfe./A  Cj) 

C/  =  ©t  A  (  ©t  A  C,)  =  C,^'/  +  Ut./A(  ©t./  A  e,)  +  ©t./  A  ((©t./  A  0*./)  A  C,) 
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+  (Ot.;  A  (Ui./  A  e,)  +  Uit.;  A  ((at-,  aCV/)  a  e,)  +  Oj./A  (Ui  ;  A  e,) 
D,^  =  A  (at  A  (at  A  e,;)  =  D,-*  > 


+  Ct.;  A  (at.;  A  (at.;  a  e,))  +  at.;  A  (Ut.;  A  (at.;  A  e,)) 


t  at.;  A  (at.;  a  (Ot.;  a  e,))  +  Ut-;  a  (at.;  A  (Ut  ;a  e,-)) 


h  Ot.;  A  (Ot.;A  (at.;  A  e,))  +  at.;  A  (Ut.;  A  (Ut.;  A  c;)) 


t  Ut.;A  (Ut.;  A  (Ut.;  A  e,)). 


Ut.;=  pt.a  ^k.a  ‘“><1  Ut.;=  pt.o  H.a. 


Based  on  the  recurrence  formulae  as  given  earlier,  the  procedure  lor  the  numerical 
evaluations  of  the  damping  and  stiffness  matrices  for  the  linearized  system  can  be 
summenzed  as  foUov/s; 

1)  For  each  time  step,  calculaung  the  vectors  9;.  ej, .,. ,  9,,  ( See  the  Eq.(:6)), 

2)  Calculaung  the  coefficients  A;,  §,;,  C„  D(;t,  and  F;  in  Eqn  (23  to  25); 

3)  Calculaung  die  operators  D;*(  p),  D2*(  p,  p),  and  Dj*(  p,  p,  p)  (Eqn.  (38  to  ao)); 

4)  Calculaung  the  coefficients  A|,  B,/,  C„  0,^t,  and  f;  m  Eqn  (19  to  21); 

5)  Calculaung  the  patual  p  and  p  denvauves  of  kinemauc  (Eqn.(26  to  33))and  mechanical 
terms  (Appendix); 

6)  Finally,  establishmg  the  damping  and  stiffness  macuices. 

Figure  4  shows  die  flow  chart  of  computauonal  aigonthm  for  the  hneanzauon  procedure 


5,  Numerical  Example 


In  Older  to  demonstrate  the  performance  of  the  nuinencal  hncarizauon  method  proposed  in 
this  paper,  the  program  has  been  applied  to  a  two  ngid  mampulator  model,  as  shown  in 
Fig  5.  The  numencal  data  of  this  mechanism,  which  are  input  data,  are  given  in  Table  n 
Table  in  compares  the  analyucal  results  through  a  direct  panial  denvauen  with  those 
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obtained  by  our  numerical  ir.:ar]zauon  procedure.  They  arc  in  good  agreement.  The 
differences  are  possibly  due  to  the  inaccuracy  of  the  hand  calculation" 


Fig. 5  Two  ngid  planner  manipulator  model. 
Table  H  Numencal  data  for  the  two  links  m  the  model 


Link(Uand  LinJ:(2) 

Link  length  (ml 

1 

Link  mass  (kg) 

60 

Area  moment  of  mema 

!xx 

5  037 

(m'*) 

lyy 

0.0733 

[zz 

5.037 

Analytical  results  Numencal  results 


i!ElM 

WSHm 

6.  Conclusion 

We  have  proposed  a  lineanzation  procedure  for  the  nonlinear  dynamic  equations,  which 
are  established  in  our  case  based  on  the  Kane’s  virtual  work  principle.  The  partial 
derivations  of  the  kinematic  terms  with  respect  to  the  generalized  coordinates  and  to  the 
generalized  velocities  have  been  fulfilled  through  the  first  and  second  order  time 
derivations  of  the  body  absolute  angular  velocities  and  through  the  first,  second,  and  third 
order  time  derivations  oi  the  mass  ccnicr  vectors,  respectively  We  have  developped  the 
specific  operators  to  perform  the  time  den^aitons  without  distinguishing  the  rigid  and 
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flexible  variables.  Thus,  ihis  method  makes  both  the  theoretical  deduction  and  the 
programming  relatively  simple,  and  allows  a  rapid  computing. 
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APPENDIX 

We  give  the  derivation  of  the  mechanical  tensor  term  with  repcct  to  the  generalized 
coordinates 

1  Defimuon  of  the  mechanical  tensor  term 

Mechanical  tensoi  terms  for  the  deformed  body  m  the  reference  frame  Ro  arc  defined  as: 
I,,  =  |(X  A  (e,  A  X)|-e,dm, 

Kii  =  |(X  A  (e,  A  ^)]’ejdm. 


JO|,  =  |(A<»a  A  (e,  A  X>|-e)dm, 

Ho=  /(X  A  i<I>aldm.  lia=  A  iOaldm.  and  |ia  .  dm. 
m  which 

AOa  -  ■  ‘!>a(0. 

and  X  IS  a  vecor  on  ihe  deformed  body,  which  is  equal  to  X=X.  +  i,a  A®ct 

2  Derivation  of  the  vectors  X.  i  and  <I>(,  with  respect  to  the  gencmjized  coordnates 

3x  .  dqiha 

J^.ekAX.  3^  =  a®o.  and  _.0|,Ai<»a 

3  Denvauon  of  the  mechanical  tensor  terms  with  respect  to  the  generalized  coordinates 

a.  j  (—  (e,AX)-Cjdm+  J  (X  a  (e,  a  “)]’ejdm 

5pk  dpk  ^Pk 
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=  Otaem-t  J  -((e.-xxx  A  e,)  +  (X ej)(x  A  e,))dm| 


■  §3jj_ 

^321 

^Pk 

3Pk 

3pk 

3J12 

^322 

3Pk 

3Pk 

3pk 

SfU 

§I21 

ajij 

-  3pk 

3pk 

3pk 

2^l3«l(2-2J|2*k3  •J|39kl*<239k2*<J|  1-3:2%  3|26kr>333-3n%-3:3ek3 

•3l3®kl*323%*<3ll-322>*k3  -2323*^+2312913  <322-333)e|(i-J|2e|(2<-J|3ei3 

3|29kl+<333-3l|)9|(2-3239l;3  (322-J33)6k|.J|29k2*Jl3e](3  2J23e|(,. 23,381^ 


^  =  n~  (*1 A  X)  ej  ]  dm  +  J  ( X  A  <e,  A  “1  c,  dm  =  Jq  +  j/ 
Ofa  o5o  «5la 


b  ^  =  I  («!  A  Sj-e.dm  +  /  (X  A  (e,  A  ^))  e,  dm 
^?k  3pk  3(H 


=  9kmem-(  J  -[(XAi)(e,  e,)-(XAe,)(S  e,)-(S  *,)(XAe,)-(x  i  e,)e,)dm) 


§!iu 

3J^ 

*J1 

3pk 

3pk 

3pk 

*22 

*J2 

1 

i 

3pk 

3pk 

3pk 

i 

3kjj 

1 

3pk 

9pk 

3pk  - 

1 
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5 

(kjl+ki3)9-u2-(l.|;+l:;,)e^3  ->.3!9(;|'fk239k2'^'‘lr''j:)®k3  *-21®ll*<^33-l‘!l)®l2-'‘32%.3  5 

•''13*ltl*'^32®k2*<''n'‘'22>%3  •l*-23+''32)9kl'*<'-I2+''2l)9i(j  <>'22-l‘33<®Vl-*'12®k2+'‘31®k3  i 

t 

-  l■l2®kl■*<''33■''H>®k:•'=23*k3  ('■22-l'33*®kl'*'2l*k2*l'13®k3  <k23+k32)eitl-(1.13+'‘3l)®k2  -1 


23=  J  (-^  (e.A  ii:)ejdm  =  J  (  A4>„  A  (e,  A  *)]  e,<im 

35a  35a 


<;  t  ii.AA«a<im+  J  X  A  ?^dra  .  efcAHt, 

3Pk  3pfc  « 


^  |ii.AA*admMxA^‘»dm.9kAft„ 


Note  that  we  di<J  not  give  the  dcnvauon  of  ituj  since  it  :s  similar  to  K,j  m  form 
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ABSTRACT.  This  paper  presents  a  computer  based  method  for  the  efficient  for¬ 
mulation  and  solution  of  the  nonlinear  equations  of  motion  for  mechanical  systems 
of  interconnected  flexible  bodies,  subject  to  motion  and/or  geometric  constraints, 
undergoing  elastic  deformation  together  with  large  rotations  and  translations.  Flexi¬ 
bility  is  modeled  through  the  use  of  admissible  functions  obtained  from  previous  finite 
element  analysis  of  the  component  bodies.  The  procedure  then  forms  the  equations  of 
motion  and  solves  for  the  system  state  derivatives  associated  with  the  unconstrained 
system  in  a  highly  efficient  Order  n  manner  The  constraint  loads  lequired  to  enforce 
the  constraint  relations  are  subsequently  determined  through  the  use  of  a  constraint 
stabilization  method  The  required  constraint  loads  arc  then  used  to  modify  the 
state  derivatives  found  previously,  resulting  m  a  set  of  state  derivative  values  which 
are  now  associated  with  the  constrained  system.  The  procedure  is  efficient,  accounts 
for  motion  induced  stiffness,  and  produces  equations  which  are  highly  concurrent 
m  form,  yielding  simulation  code  which  lends  itself  well  to  application  on  parallel 
computers 


1.  Introduction 

Much  work  has  been  done  m  the  development  of  simulation  procedures  and  computer 
codes  for  multibody  dynamic  systems  since  the  pioneering  work  of  Hooker  and  Mar- 
gulies  [I]  over  twenty-five  years  ago.  During  this  period  many  simulation  procedures 
and  associated  simulation  codes  ha’^e  been  developed  for  treating  a  wide  wieiy  of 
systems.  When  the  systems  are  modeled  as  containing  only  rigid  bodies,  the  result¬ 
ing  equations  of  motion  are  exact  However,  m  many  applications  some  or  all  of  the 
component  bodies  must  be  treated  as  flexible,  and  in  these  instances  the  story  is 
quite  different  Here,  one  finds  many  assumptions,  approximations,  computational 
concerns,  open  issues,  and  a  good  deal  of  debate 

Compheatmg  the  situation  still  further  is  the  issue  of  computational  speed  and 


throughput.  In  the  past  it  was  often  the  case  that  computational  efficiency  and  speed 
were  sacrificed  Tor  the  sake  of  codes  which  could  handle  more  general  systems,  or  that 
accuracy  was  r^ten  sacrificed  foi  the  sake  of  computational  speed  [2]  However,  for 
analytical  modeling  and  computer  simulation  to  be  ar  effective  tool,  it  must  be  ac¬ 
curate.  fast,  and  economical  The  design  process  may  lequire  many  simulations,  and 
may  thus  be  limited  by  time  and/or  monetary  constraints  .-Vs  a  result,  recent  years 
have  seen  great  emphasis  placed  on  developing  algorithms  and  simulation  programs 
which  are  computationally  efficient /economical,  while  remaining  general  enough  to 
be  adequately  used  a.s  analysis  tools  for  a  wide  variety  of  rigid  and  flexible  multibody 
systems  [2*9|. 

Presented  m  this  paper  is  one  such  approach,  based  on  a  highly  efficient  Order 
n  algorithm,  for  dealing  with  multibody  dynamic  systems.  The  recursive  method 
uses  relative  coordinates  for  rigid  body  displacements,  and  shape  functions  obtained 
from  finite  element  modal  analysis  of  the  component  bodies  as  admissible  functions 
for  the  representation  of  elastic  body  flexibility  The  formulation  considers  motion 
induced  stiffening  (too  often  neglected),  and  the  approach  can  be  applied  to  both 
tree  and  closed  loop  configurations.  The  resulting  equations  of  motion  are  highly 
parallel  m  form  and  lend  themselves  well  to  application  on  loosely  coupled  distributed 
architecture  parallel  computers 

2.  Analytical  Development 

Consider  a  system  of  vV  interconnected  flexible  bodies  The  flexib’hiy  of  each  body 
is  approximated  through  the  use  of  a  fimte  set  of  admissible  shape  functions  and 
associated  modal  coordinates,  with  the  interbody  joints  each  contributing  from  zero 
to  SIX  rigid  body  degrees  of  freedom  to  the  system  total.  If  the  total  number  flexible 
body  and  rigid  body  degrees  of  freedom  is  n,  and  P  is  define  to  be  a  differential 
element  of  an  arbitrary  body  of  the  system,  then  the  angular  velocity  and  velocity  of 
P  in  the  inertia  reference  frame  N  can  be  respectively  expressed  as 

+  and  v^  =  ^vfur  +  vf,  (1) 

r*l  >'«1 

where,  by  definition  [lOj:  ui,...,Un  are  generalized  speeds,  quantities  which  charac¬ 
terize  the  motion  of  the  system,  and,  wf*  and  vj*  are  the  rth  partial  angular  velocity 
and  partial  velocity  of  P  m  iV,  respectively 

If  R  represents  the  resultant  of  ill  distance,  contact,  and  elastic  forces  acting  on 
P,  and  R*  are  the  inertia  forces  associated  with  P,  then  the  equations  of  motion  are 
given  by 

y  .  y  , 

^  /  V,  RVV‘  =  0  (r  =  l,.  .,«)  (2) 

Unfortuately,  proceeding  in  this  manner  yields  a  number  of  difficulties  The  equations 
of  motion  which  are  produced  as  per  Eqs  (2)  are  incorrectly  hne2irized  m  the  modal 
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coordinates  and  there  time  derivatives  derivatives  This  can  lead  to  significant  error 
where  motion  induced  stiffness  is  involved.  In  addition,  the  integration  over  the  vol¬ 
ume  of  each  body  and  the  indicated  summations  over  all  bodies  of  the  system  at  each 
time  step  can  be  computationally  expensive  Furthermore,  the  resulting  equations 
of  motions  are  highly  coupled  m  the  state  derivatives,  thus  requiring  computation¬ 
ally  expensive  decomposition  of  the  mass  matrix  before  the  state  derivatives  can  be 
solved  for  and  the  equations  of  motion  can  be  temporally  integrated  Each  of  these 
difficulties  will  be  addressed  subsequently. 

2.1  NOTATION  AND  GEOMETRY 

Once  the  identification  number  k  for  each  body  in  the  system  has  been  properly 
assigned,  the  topology  of  the  system  is  uniquely  defined  by  identification  numbers 
of  the  proximal  bodies  The  notation  Pr[fc)  refers  to  the  set  containing  only  the 
proximal  body  of  the  S*.  Pr  is  called  the  proztmal  body  array,  and  the  convention 
that  =  0  IS  used  if  is  a  base  body  where  bodies  0  and  N  are  synonymous 
labels  for  the  mcrtiai  reference  frame  It  is  also  useful  to  introduce  an  additional  set 
jDisfjibl  to  characterize  the  system’s  topolog>'.  The  notation  Disfjfc]  refers  to  a  set  of 
body  numbers  defined  as 

Distil  =  (3) 

where  Dist  is  called  the  distal  body  set  array 

Throughout  this  paper,  scalar  quantities  will  be  represented  as  plain  faced  Vec¬ 
tor  quantities  will  be  denoted  by  bold  symbols,  while  matrices  are  shown  as  plain 
faced  with  an  underbar.  Dyadics  are  represented  by  bold  faced  symbols  with  an 
under  tilde,  while  matrices  composed  of  either  vector  or  dyadic  quantities  are  repre¬ 
sented  by  bold  faced  symbols  with  an  underbar.  For  example,  the  symbols  A,  A.  4, 
A,  and  represent  a  scalar,  vector,  matnx,  dyadic,  and  matrix  of  vector  or  dyadic 
quantities,  respectively  Unless  stated  otherwise,  a  miable  in  the  subsenpt  preceded 
by  a  comma  indicates  differentiation  with  respect  to  that  variable,  and  summations 
are  carried  out  over  repeated  indices,  with  indices  /,m,o,p  =  1.2,3,  9  =  1,  .21, 

=  .,/i®  ,  and  j  =  1,.  .  For  each  of  these,  and  are,  respec¬ 

tively,  the  number  of  flexible  degrees  of  freedom  associated  with  body  B*,  and  the 
number  of  rigid  body  degrees  of  freedom  associated  with  joint  connecting  B*  to 

The  joints  between  adjacent  bodies  can  be  thought  of  as  being  composed  of  a 
senes  of  properly  oriented  single  degree  of  freedom  revolute  or  prismatic  “subjoints” 
connected  via  massless/dimensionless  links.  Thus,  if  joint  J*  is  a  six  degree  of  free¬ 
dom  free  joint,  then  it  can  be  described  by  the  set  of  single  degree  of  freedom  subjomts 
Jf,  .  ,Jl.  The  value  of  generalized  coordinate  representing  the  relative  posi- 
tion/orientation  of  the  subjoint/body  7*  with  respect  to  its  proximal  subjomt/body 
m  the  direction  of  unit  vector  7* 

A  typical  flexible  body  of  the  system  is  defined  as  a  body  B*  which  undergoes 
relative  rigid  body  motion  with  respect  to  its  proximal  body  and  deforms 

elastically,  Fig  1  Let  n®  ^  be  the  reference  frame  of  B*  with  respect  to  which  the 
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deformation  of  the  body  is  given.  Reference  frame  n®  '  represents  the  frame  within 
whica  the  dextraJ  mutually  perpendicular  unit  vectors  nf  ‘  nf  *  are  fixed 

and  which  is  itself  fixed  with  respect  to  point  P®  •*,  the  grid  point  of  the  finite 
element  representation  of  B*.  The  point  for  which ;  =  J'‘,  is  that  point  of  B''  which 
connects  B*  to  through  joint  7* 

The  position  of  an  arbitrary  *  of  B*^  with  respect  to  P*-'^*  is  given  by  the 
position  vector 


C  =  P  +  9, 


(4) 


where  p*’*  and  are  the  position  vector  of  P*’*  m  undeformed  B*,  and  the  admis* 
sible  shape  function  matrix  associated  with  the  translation  of  P*'*,  respectively  The 
body  B*  has  modal  deformation  coordinates  associated  with  it.  where  is  the 
coordinate.  In  a  like  manner^  the  angular  position  of  a  node  at  P*’*  with  respect 
to  P-^  ,  6^'\  arising  from  the  deformation  of  B‘,  is  expressed  m  terms  of  modal 
coordinates,  ,  and  rotational  deformation  shape  functions.  If  vj-'  is  defined  to  be 
the  rotational  shape  function  associated  with  q,  at  P**‘  with  respect  to  P-^* ,  then 
is  given  by 


=  Vt, 


(5) 


Finally,  unless  otherwise  specified,  all  time  differentiations  are  taken  m  the  inertia 
frame. 


2.2  MODAL  REPRESENTATION  AND  GEOMETRIC  STIFFENING 

To  reduce  the  large  number  of  elastic  coordinates,  a  standard  component  mode  tech¬ 
nique  is  utilized  (11}.  This  approach  involves  using  a  relatively  sm^l  number  of  shape 
functions  for  each  clastic  body.  The  shape  functions  used  consist  of  selected  vibra¬ 
tion  modes,  all  constrejnt  modes,  and  any  necessary  static  correction  modes  The 
important  issue  of  how  these  modes  are  best  selected  is  a  area  much  on  going  work 
m  the  muUibody  dynamics  community  and  will  not  be  addressed  here. 

Linear  strain  energy  theory  assumes  that  the  deformation  components  are  inde¬ 
pendent  But  in  systems  involving  high  rotation  rates,  high  radial  forces  can  occur 
and  the  coupling  between  radial  and  transverse  deflections  becomes  significant.  Un¬ 
fortunately,  the  use  of  modal  coordinates  in  modeling  flexibility  results  in  equations 
of  motion  which  are  incorrectly  linearized  with  respect  to  these  coordinates  and  there 
time  derivatives  For  this  reason  higher  order  strain  energy  terms  need  to  be  consid¬ 
ered.  These  terms  are  used  in  the  generation  of  geometric  stiffness  expressions  which 
are  added  to  the  existing  equations  to  correct  for  the  premature  linearization  in  the 
modal  terms  Methods  such  as  those  discussed  in  references  [12}  zmd  [13}  produce  ge¬ 
ometric  stiffness  terms  which  require  iterative  updates,  and  thus  are  computationally 
expensive  By  companson,  reference  jl4)  pr,'sents  a  technique  which  applies  to  gen¬ 
eral  flexible  structures  and  requires  the  deteimmalion  of  a  set  of  geometric  stiffness 
matrices  only  once 
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This  latter  technique  is  the  one  which  is  used  m  this  paper,  modified  to  make  this 
method  compatible  with  the  0(n)  formulation  As  given  m  Ref.  {14].  the  element 
geometric  stiffness  is 


^ttolL  ^tyolL  ^tiolL 
<^Z9oU. 

OttdU. 


d\\ 


(6) 


where  ^x^y^z)  is  the  (3  x  e^ndof)  matrix  of  interpolation  functions,  with  or,  y,  z. 
as  local  coordinates.  The  stresses  <t,;o  (*»J  =  x,y,z)  are  those  arising  from  the  loads 
applied  to  the  nodes  of  the  element,  the  quantity  t-ndof  represents  the  number  of 
element  degrees-of-freedom,  and  (7  is  a  (3  x  3)  identity  matrix 


Finite  element  codes,  such  as  NASTRAN  can  compute  the  geometric  stiffness  as¬ 
sociated  with  a  pi  escribed  distnbuted  load  by  first  calculating  the  associated  element 
stresses,  these  element  stresses  then  being  used  in  the  determination  of  the  element 
geometric  stiffness  matrices  as  per  Eq.(6)  Finally,  the  element  geometric  stiffness 
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matrices  are  assembled  into  the  body  geometric  stiffness  matrix  A'®* 

The  overall  geometric  stiffness  matrix  for  B*.  A’^‘ ,  is  constructed  from  twenty- 
one  time  m\-ariant  contributing  matrices,  A'^*  (^  =  1,.  .  21),  and  their  associated 
remroral  scalars.  which  arise  from  the  inertia  loads  in  B*  In  addition,  there  are 
another  six  contributing  time  invariant  matrices.  A'®*^  {;  S  k  =  i.  .  .6). 

and  their  associated  temporal  scalars.  ,  which  are  affiliated  with  each  distal  body 
to  B*  and  account  for  the  geometric  stiffening  m  B*  due  to  loads  applied  to  it  by  each 
of  these  distal  bodies  through  the  corresponding  imerbody  joint.  Specifically, 

-^G,  +  Ag^)  -J-  ^ 

(7) 

(g-L  .21;  ;  6  h  -  1.  .6) 


2  3  U.N’CONSTR  U.VED  SYSTEMS 


Key  to  the  reduction  m  the  number  of  required  operations  is  the  removal  of  sum¬ 
mations  which  appear  in  Eq  (2)  and  the  associated  geometric  stiffness  corrective 
terms.  The  indicated  summation  can  be  eliminated  entirely  through  the  recursive 
shifting  of  active  and  inertia  forces  to  their  proximal  bodies  The  state  derivatives 
can  then  be  determined  inexpensively  through  the  recursive  triangularizaiion  and 
back-substitution  of  the  resulting  equations  (6-8].  The  arguments  of  the  integrals 
may  be  split  into  spatial  and  temporal  parts,  with  the  indicated  spatial  integrations 
needing  to  be  carried  out  only  once.  The  temporal  quantities  are  then  multiplied  by 
time  invariant  coefficients  resulting  from  the  spatial  integration. 

Determination  of  Generalized  Forces  and  Triangularization  of  Equa¬ 
tions.  Differentiating  Eqs  (1)  with  respect  to  time  yields 


and 


dt 


•''dv'’ 

dt 


(;f;<.;fu,+a.r)=a'’  +  S'’ 

r*l 

(fv,V  +  vr)  =  a''  +  S'' 


(8; 


(9) 


for  the  angular  acceleration  of  P  in  iV,  and  the  acceleration  of  P  in  N,  xespectively 
The  quantities  d^,  a^,  ^.onlaia  all  terms  explicit  in  the  unknown  state  derivatives, 
ui,  .Un,  while  and  a^  contains  all  else. 

Now  consider  P  not  as  an  infinitesimal  particle,  but  as  a  discrete  quantity,  either 
a  grid  point  P^  '*  of  a  finite  element  discretization  of  the  body,  or  a  subjomt  7* 
Then  the  mass  and  central  inertia  dyadics  associated  with  P,  54^  and  I^.  are  defined 
as 

and  =  (10) 
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where  is  the  mass  lumped  at  P 

If  IS  written  as  p^  =  pfnf  —  pfnf  +  pf  nf,  then  we  define  the  dyadic  p£x 
as 

fill?  =  +^r«fnf -pf  »?'>{' -pfnfnf -^fnfnf  (11) 


^  ~[o  y^  J  -  Is  y 


(16) 


The  terms  and  appearing  in  Eq  (14)  are  the  torque  and  force  which  line  of 
action  passes  through  P,  and  which  together  are  equmlent  to  the  set  of  all  distance, 
contact  and  elastic  forces  (except  those  arising  from  geometric  stiffness)  acting  on  P 
In  addition,  from  the  corrective  term  matrix,  Hq  i  forces/torques  which  arise  due 
to  geometric  stiffness  and  given  by 


through  matrix  manipulation,  one  can  construct 

+  L  if'  '  [??  a^+£^'+(2) 

jeDi.iHI  ‘ 


(17) 


(18) 


1 


Having  the  quanties  d'’.  al”,  3^.  l'’.  and  so  defined,  introduce 

,  jk  „ 

£r  '  Q‘  2ind  S  for  notational  ease  as  ^ 

Wr' 

U'. 

oil 

and  =  [S 

(12) 

if' 

a  0  1 

[  Q  M®‘'J 

,  a  fl7/ 

and  I,'  = 

m''*  ]  ■ 

(13) 

i  -M®' 

’"■•xl®*''  u8‘o  +  t®‘  ' 
.  seO  q  as*,. 

j  and 

if  S  (-!'.■  >l 

-w7‘  xX^,*  +T7<' 

M-'*  •  a-'*  +  R^‘ 

(14) 

and  a''  =  1“';  ] 

(15) 

ISS 


where  the  vector  quantities  T®  *  and  R®*  ‘  are  the  tnrque/force  pair  which  acts 


on  §nd  t  of  B*'  due  to  geometric  stiffness:  T  ’  are  matrices  of  djadic  quantities 

associated  with  the  geometric  stiffness  due  (o  body  B*  inertia  loads:  £  arc  a 
matrices  of  dyadic  quantities  associated  with  tne  geometric  stiffness  due  to  applied 
constraint,  and/or  nuerbody  loads  acting  at  point  h  of  B*.  and  =  [T-^' 

Starting  from  the  terminal  booies  and  working  inward,  the  composite  inertia  val¬ 
ues  as  well  as  the  active  force  and  inertia  remainder  term  portions  of  the  inertia  forces 
are  determined  for  the  tnangulanzed  equations  by  recursively  using  the  relationships 


trB* .i  ^ 

±A  -  il 


f  ■■ 

. . .  = 

It-'.'"'""  = 


Where  if* and£f'"'*  are  defined  as 


•  (5® 

■f 

SB>. 

€.‘") 

if 

'  +£®‘ 

•  tr'Y 

E 

[gO>„ 

rf'' 

‘if* 

±5 

£f*-’*^f;^S''‘-‘  £f‘‘  +  (5''‘'  lf‘-'  f.*-‘)<ir+5®‘'  hL''\T 


if"  i'A*  E  (lE(tJ'‘)^ 


f*  zi'  l 


I 


KwiBwti.; 


^yt,eirv^V‘fSSXr^'!^ 


and 


where 


f‘ =i:((2i'’)''  ^rv‘) 

E  ((E(«;-)’' rf'i 

j6DiJt;k)\^  I  •*  / 


and 


with 


ff=  E((«‘")^  f.  yf 


E  flEce-r-rf'i^r-zf''^'  (s'**' 

leDt.iWV'-  •  •' 


{251 


(261 


(27) 


For  the  rigid  body  degrees  of  fieedom  the  expressions  for  2^  and  are 


li'  {s^'f 

!;■  4  ri'  r|,T 


(28) 


£i'-'  =£i--'  +S-''  4Ei’ 

ij  zi'] 

zi’  zir 


(29) 


With£f  s2ind^^"^  sodefined.  the  equations  of  motiou  can 


be  written  in  the  form 


TABLE  L  commued 


Mode 

Frequency 

30  Hi 

90H2 

130  Hi 

23 

839 

700 

060 

-010 

24 

84.0 

206 

0.75 

004 

25 

85.6 

225 

1.38 

004 

26 

85.7 

232 

283 

•0.02 

27 

98.1 

375 

7.21 

0.02 

28 

99.0 

391 

957 

035 

29 

99.7 

537 

9.63 

019 

30 

104.0 

578 

8.10 

0.03 

31 

104.1 

670 

12.0 

024 

32 

104J 

943 

12.2 

031 

33 

105.9 

1018 

106 

0.07 

34 

117J 

964 

194 

0.22 

35 

117.5 

1000 

19.4 

0.29 

36 

117.7 

1043 

523 

0.38 

37 

120.1 

1072 

49.7 

0.43 

38 

125.5 

1334 

446 

010 

39 

127.4 

1368 

Tas 

0.97 

40 

1336 

14S3 

9a6 

0.00 

«dof 

3350 

46 

62 

76 

llius.  using  CMS  procedures,  it  is  possible  u>  agnificandy  reduce  tfae  number  of  degrees  of  freedom 
as  well  as  subdivide  the  global  strucoire  into  substructures  that  may  allow  future  modificanoos  to  be 
accompbsbed  more  effioeotly.  For  exam^,  if  ibe  required  modificaticn  only  Livolves  specific 
components,  then  it  is  not  necessary  to  recompute  tfae  chanctetisncs  of  the  unmodified  compOTcms. 
Itiis  can  lead  to  substantial  tune  savings.  In  tfae  telescope  focus  umt  analysis,  the  effea  of  changing 
tfae  gjflhftM  of  die  bearings  between  the  inner  and  outer  tubes  of  the  focus  umt  was  mvesogaied. 
Modificanoo  of  this  stiffness  and  re*analysi$  of  tfae  com{dete  problem  took  22%  of  the  ome  required 
fortbobasefine  CMS  analysis.  Ibus  in  situanocs  where  many  such  re-analyses  have  to  be  computed 
m  order  to  obtain  a  system  widi  the  desued  response  characteristics,  the  benefits  of  usmg  a  CMS 
procedure  may  be  signtficaiu. 
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i  =  0  and 


)''  \tT'  ']  =0  f30) 


fc  the  case  where  r  :s  associated  with  the  generahzed  speed  uj*  and  uf  *  respectively 

Eqns  (21)*(23).  (2o),  (27),  and  (30)  contain  summations  of  quantities  associated 
with  all  grid  points  used  in  the  finite  element  discretization  of  These  spatial  sum¬ 
mations  (integrations  i  are  only  performed  once,  producing  time  m\'anant  coefficients 
to  the  temporal  quantities 

What  IS  important  in  equations  of  motion  (30)  is  that  the  state  derivatives  which 
are  in  evidence  in  the  ^  terms  are  limited  to  those  associated  with  the  generalized 
coordinates  of  the  ancestral  bodies,  the  bodies  which  form  the  path  between  the 
inertial  frame  and  the  body  under  consideration  (6.  8)  Thus,  working  recursively 
inward  to  the  lowest  rigid  body  degree-of-freedom  of  the  6asc  body,  we  have 


where  =  Ej,  u 


Substituting  the  second  expression  (31)  into  the  first  yields 


(31) 


(32) 


providing  the  value  of  uf  in  terms  of  known  quantities. 

Recursive  Back-substitution.  This  known  vaiue  for  u{'  is  used  to  start  the 
back-substitution  process  for  the  determination  of  the  remaining  generalized  speed 
derivatives.  The  recursive  relationships  used  here  are 


and 


-i2if 


’  zi'  2I, 

for  rigid  body  degrees  of  freedom  and 


fd  {sf'f  d-+dl 


(33) 


(34) 


A"'-'  =  with  «f‘  =  df ‘  +  gf‘  A”'  "'  (35) 

for  flexible  body  degrees  of  freedom  u/'  is  substituted  into  Eq.(33)  for  the  determi- 

-  j*  /*  • 

nation  of  ^  \  which  is  m  turn  used  in  Eq  (34)  for  the  determination  of  uj  This 


US 


_ !•;>' 


process  is  repeated  v.’orkmg  recursi\eiy  outward  to  determine  the  remammc  joint  ac¬ 
celerations.  with  the  state  derivatives  associated  with  the  flexible  degrees  of  freedom 
determined  through  the  use  of  Eqs.(35)  The  end  result  is  that  the  rigid  body  degrees 
of  freedom  are  uncoupled  anti  the  relative  joint  accelerations.  Uj  {k  =  1  ..V*  and 

;  =  1. , .  .  )  are  determinea  m  0(.V)  operations  overall  for  a  general  tree  struc¬ 

ture 

2.4  EXTENSION  TO  CONSTRAINED  SYSTEMS 

The  dynamical  equations  presented  so  far  apply  only  to  tree  configurations  which  are 
not  subject  to  either  motion  or  configuration  constraints  If  a  system  has  one  or  more 
constraints  on  its  geometry  or  motion*  then  additional  equations  must  be  satisfied. 

Consider  an  unconstrained  multibody  dynamical  system  possessing  n  degrees 
of  freedom.  The  motion  of  the  system  is  fully  specified  by  the  generalized  speeds, 
ui,.  Un^  which  are  independent  of  each  otner  If  the  system  is  subjected  to  m 
conditions  of  the  form 

‘^,(^,0=0  and  =  0  (i-f;  =  l..  .m)  (36) 

for  holononuc  and  nonholonomic  constraints,  respectively,  then  the  motion  of  the 
system  m  a  Newtonian  reference  frame  is  characterized  by  n  generalized  speeds 
m , . .  ,  Un  which  are  not  independent  of  each  other,  but  must  satisfy  m  simple  non¬ 
holonomic  constraints,  or  holononuc  constraints  differentiated  once  with  respect  to 
time.  Such  constraint  equations  are  of  the  form 

J^Ar,Ur  +  B,  =  0  («  =  !,..  ,m)  (37) 

r«t 

where  An  and  Bt  are  explicit  functions  of  &nd  time  f  As  a  consequence  of 

the  imposition  of  these  constraints,  the  number  of  degrees  of  freedom  of  the  system 
reduces  from  n  to  p  =  n  -  m. 

The  procedure  presented  here  for  the  formulation  of  the  equations  of  motion  for 
systems  subject  to  constraints  is  a  variation  on  that  presented  by  Park  [15,16],  and 
applied  to  an  0{n)  approach  in  Refs  {6]  and  [8]. 

It  can  be  shown  [8]  that  the  equations  of  motion  for  the  constrained  system  can 
be  written  in  the  form 

4 +  £^  =  2  subject  to  +  =  Q  (38) 

Solving  the  first  expression  in  (38)  for  u  and  substituting  this  into  the  first  time 
derivative  of  the  penalty  equation, 

4=i(4u+/i«+a).  (39) 

yields 

4- /i£(A =  4^4- /lu (40) 
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where  c  is  a  positive  constant  chosen  by  the  analyst,  with  ki  and  being  control 
gams  tor  stabilization  of  constraint  eolation  error. 

The  solution  of  this  ordinary  differential  equation  m  /«  decays  to  the  constraint 
load  measure  number.  \'aiues  \Vhen  constraints  are  present,  the  procedure  follows 
much  the  same  course  as  the  basic  algorithm  presented  in  the  previous  section,  but 
now  the  presence  of  the  unknown  constrmnt  force  measure  numbers  in  the  equations 
of  motion  must  be  considered  This  algonthm.  like  most  others,  requires  that  the 
system  be  a  tree  structure.  This  necessitates  that  closed  loops  be  cut  at  the  joints 
connecting  appropriate  bodies  so  that  the  required  open  loop  structure  is  produced. 
The  constraint  conditions  which  insure  closure  of  the  loops  are  then  enforced  through 
the  addition  of  constraint  forces  and  moments  of  proper  magnitude  and  direction, 
applied  at  the  connection  points.  In  the  basic  algonthm.  the  set  of  all  distance  and 
contact  forces  acting  on  are  given  by  the  reaction  ’*  and  torque  T®  ‘  The 
presence  of  the  constraint  forces  Rf  and  constraint  torques  Xf  must  now  also 
be  considered. 

From  these  we  define 


where  h  is  the  point  of  B*  through  which  a  constraint  is  applied. 
Defining  the  quantities  df*,  ’*  and  as 


(41) 


jeDi.tui''-  . 


(«) 


(43) 


(44) 
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the  state  derivatives  for  the  constrained  system  are  given  by 


Expressing  jx  as 

=  2  +  C  (47) 

where  C  is  that  portion  of  u  which  is  explicit  m  the  constraint  load  measure  numbers 
and  r?  Is  all  else;  rj  is  simply  equal  to  «  for  the  identical  system  when  no  constraints 
are  imposed  and  Is  given  by  eqs  (33)-(35).  In  a  similar  manner,  the  elements  of  C  are 
given  by  the  relations 


-iz'h 


■  [zi'  (Sf’f-V’  +£>''  +£j'\  =  - z ,  (48) 


where 


m 

ij  =  {§/!)  and  cf‘=df+£f‘f  =-ErB.,/c,  (49) 


4  (5®*’')’"  c®'"'*  +#;’'cr  (50) 

So.  the  equations  of  motion  for  the  constrained  system  may  be  rewritten  as 

where  £  is  defined  by  (48)  and  (49),  and  fc  is  obtained  from  Eq.(40).  The  state 
derivatives  are  then  calculated  from  Eq  (51),  with  the  total  procedure  requiring  ap¬ 
proximately  0{n  -f  m^)  operations  for  ngid  body  systems. 


3.  Numerical  Examples 

Two  example  are  provided  to  validate  the  forraulaticj  vnd  offer  evidence  of  the 
improved  performance  possible  when  using  0{n)  fc  lulation  for  the  analysis  of 
syatems  containing  a  large  number  of  bodies. 

3.1  CANTILEVER  BEAM  WITH  PRESCRIBED  BASE  MOTION 


The  system  discussed  here  consists  of  a  cantilever  beam  attached  to  a  base  with 
prescribed  angulw  \elocity  -  an  example  used  as  a  benchmark  test  by  a  number  of 
authors.  Refs.  114,t7-19j.  The  generalized  coordinates  used  in  this  problem  are  the 
four  modal  coordinates  and  the  angular  velocity  of  the  base  is  given  by 

a,(i)=/|['-TK?|)]  ■f<<15sec 

[  6  0  (rad/sec)  if  i  >  15  sec  ^  ^ 

The  beam  geometry  and  properties  wluch  appear  m  this  example  were  those  used 
by  Ryan  [18],  as  v-ell  as  Wallrapp  and  Schwertassek  (I9j 

Figure  2  shows  the  tip  deflection  of  the  beam  central  axis  from  its  undeformed 
position  during  the  course  of  a  20  second  simulation.  The  results  agree  well  with 
those  obtained  using  the  formulation  presented  m  Ref.  (17). 


Time  (sec.J 

Fig.  2;  Tip  deflection  of  rotating  cantilever  beam 


3.2  5-vBODY  CHAIN  WITH  CONSTRAINED  ENDS 

The  system  consists  of  a  chain  of  rigid  bodies  with  each  end  of  the  chain  connected  to 
a  point  iixed  m  an  inertial  reference  frame.  The  5  bodies  of  the  chain  are  connected 
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to  each  other  zind  to  points  fixed  in  the  inertial  frame  bv  two  degree  of  freedom 
Hooke's  joints. 

If  n  reprc^nts  the  number  of  degrees  of  freedom  associated  with  the  uncon¬ 
strained  system,  then  the  system  has  |  bodies,  j  -f- 1  joints,  and  the  actual  number 
of  system  degrees  of  freedom  is  p  =  n  -  3.  The  motion  of  the  system  was  simulated 
for  n  =  4,  12.  20,  28,  36  and  44. 

Results  obtained  from  simulation  codes  produced  using  the  0{n)  algorithm  pre¬ 
sented  in  this  paper  were  verified  through  direct  comparison  with  results  obtained  for 
identical  systems  using  simulation  codes  written  from  equations  of  motion  derived 
using  a  more  traditional  )  procedure. 

The  simulation  results  obtained  by  each  of  the  two  formulations  were  effectively 
identical.  However,  as  indicated  in  Fig.  3,  the  CPU  times  required  m  performing  a 
desired  1.0  second  simulation  differ  markedly  for  each  of  these  formulations  when  n 
IS  large.  It  is  readily  seen  from  the  figure  that  substantial  saving  in  computer  time 
and  associated  cost  are  possible  when  using  an  0(n)  formulation  relative  to  more 
conventional  0{n)^  formulations. 
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4.0  Concluding  Remarks 


A  general  formulation  is  presented  for  the  analysis  of  transient  response  of  multi¬ 
body  systems  with  flexible  members  The  method  uses  admissible  shape  functions 
derived  from  finite  element  modeling  of  the  component  members  and  thus  allows  the 
modeling  of  flexibility  for  general  bodies  The  formulations  treats  the  general  case 
of  coupled  large  rigid  body  displacements,  linear  elastic  deformation,  and  .ncludes  a 
first  order  representation  geometric  stiffening  effects. 

The  formulation  presented  applies  to  systems  involving  three-dimensional  mo¬ 
tions.  which  may  be  comprised  of  any  joint  type  which  can  be  modeled  as  a  series 
of  revolute  and  prismatic  joints.  The  equations  of  motion  produced  in  this  manner 
are  uncoupled  in  the  rigid  body  degrees  of  freedom,  with  coupling  only  existing  be¬ 
tween  the  flexible  degrees  of  freedom  associated  with  the  individual  flexible  bodies. 
Furthermore,  the  equations  arc  generated  in  a  form  which  exploits  the  coarse  gram 
concurrency  of  the  mathematical  model  to  the  maximum  degree.  Thus,  the  computer 
simulation  code  produced  from  this  type  of  formulation  is  particularly  well  suited  for 
application  on  some  forms  of  parallel  computers. 
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ABSTRACT 

A  new  procedure  j«i  proposed  for  implicit  dynamic  analysts  using  the  finite  clement 
method  The  mam  aim  is  to  give  stable  solutions  with  large  time-steps  m  the 
presence  of  significant  rigid  body  motions,  m  particular  rotations  In  contrast  to 
most  conventional  a;proaches.  the  time  integration  strategy  is  closely  linked  lO  the 
"element  technology”  with  the  latter  involving  a  form  of  co-rotational  procedure 
For  the  undamped  situation,  the  solution  procedure  leads  to  an  algonthm  that 
exactly  conserves  en'irgy  when  constant  external  forces  are  applied  (i.e.  with 
gravity  loading). 


1.  Introduction 

Stewan  (Ij  has  highlighted  the  potential  dangers  of  false  solution  from 
nmc-intcgranon  procedures  with  non-linear  dynamics.  For  the  finite  element 
method,  conventional  procedures  can  be  divided  imo  two  mam  types’  explicit  and 
implicit.  The  former  is  traditionally  used  for  wavc-propa,"ation  and  high-velocuy 
impact  problems  while  the  latter  is  more  appropriate  for  structural  applications 
dominated  by  the  low  frequency  response  although  Dowi,'-.  ;t  al  (2)  have  recently 
desenbed  an  energy  conserving  cxplK’t  algonthm  that  gives  excellent  results  for 
the  latter  problems.  The  present  paper  is  devoted  to  implicit  methods. 

Conventional  techniques  adopt  very  similar  prcdictor/corrccior  procedures  to 
those  used  for  non-lmcar  statics  Howevtr,  the  out-of-balarce  force  vector  is  now 
augmented  by  the  mass-timcs-acceleratioi'  tcims  while  the  conventional  static 
tangent  stiffness  matnx  is  augmented  by  a  factor  times  the  mass  matrix  if,  as 
here,  no  damping  is  considered.  Dynamic  equilibnum  is  usually  enforced  at  the 
end  of  the  step. 

Vanous  iime-integrauon  strategics  can  be  used  for  up-dating  the  velocities 
ana  accelerations  with  me  Newmark  methods  (3-5)  often  being  used  In  the 
present  paper,  the  average  accelcninon  method  (or  trapezoidal  rule  with  P  »  1/4 
and  y  =  1/2)  will  be  used  lo  represent  the  "conventional  procedure'  The  latter 
technique  is  "unconamonally  stable"  (irrespective  of  the  time  step)  for  linear 
problems  However,  this  staotlity  docs  not  extend  to  non-hncar  systems  and 
consequently,  as  will  be  shown  in  the  paper,  me  ’conventional  method"  often 
requires  absurdly  small  time  steps  if  the  solution  is  not  to  "lock  "  onto  a  higher 


energy  state  (see  later)  Attempts  to  overcome  these  djfficultjes  have  been  made 
by  both  Haug  et  al  (7)  and  Hughes  et  al  (8)  who  used  Lagrangian  muittphers  to 
enforce  an  energy  constraint 

In  a  standard  algorithm,  the  time-integration  procedure  is  totally  divorced 
from  the  "element  technology"  (with  the  exception  of  the  provision  of  the  mass 
matrix)  Most  implicit  dynamic  procedures  sausfy  the  dynamic  equihbnum  at  the 
end  of  the  step.  More  recently,  Simo  and  co-workers  have  explored  the  idea  of  a 
"mid-point  equilibrium'’  (9.10]  which  follows  on  from  thi  work  of  Hilber  et  al 
(11]  and  Zienkiewicz  et  al  (12)  These  concepts  vill  oe  taken  further  in  the 
present  paper. 

A  key  feature  relates  to  the  precise  definition  of  the  stresses  and  strains  that 
are  associated  with  the  ’’mid-point'’  configuration.  The  present  method  relics 
heavily  on  co-rotational  concepts  (6,13).  The  latter  have  usually  been  used  for 
statics  with  the  key  aim  being  to  divorce  the  straining  from  the  ngid  body 
motions,  in  particular  the  ngid-body  rotation.  The  authors  have  extended  the  ideas 
to  dynamics  (14.15]  i^nd.  to  thts  end.  have  used  both  a  mid-point  configuration 
and  averaged  strains’'  Similar  ideas  (although  without  the  co-rotational 
framework)  have  recently  been  desenbed  by  Simo  and  Tamow  (16,17)  m  order  to 
develop  algonthms  that  conserve  energy  when  constant  external  forces  are  applied. 

In  the  first  pan  of  the  pa^r.  the  theory  is  developed  for  simple 
two-dimensional  truss  ele.mems  and  this  is  followed  by  a  set  of  examples 
involving  such  elements.  In  the  final  pan  of  the  paper,  the  theory  is  desenbed 
for  the  extension  to  two-dimensional  beams  and.  in  addition,  ideas  are  outlined  for 
the  extension  to  three-dimensional  beams  and  shells. 


2,  Motivation 

The  work  was  inggcrcd  by  the 
authors  first  attempts  to  apply 
dynamics  to  the  simple  pendulum 
shown  tn  Fig.  1  (with  E.\  = 

This  problem  has  been 
discussed  in  detail  by  Bathe  in 
his  book  [4]  and  study  guide 
(18).  In  both  cases,  the 
pendulum  was  dropped  from  the 
honzonia)  position.  while  m 

the  present  analysis,  it  is 
"fired’  with  an  initial 
horizontal  velocity  of  772.5 
cm/sec.  from  the  vertical 
position  The  basic  behaviour 

is  very  similar. 

From  the  response  in  Fig.  2, 
one  can  sec  that  although  the  penod  is  of  the  order  of  4C  seconds  ’’conventional 
procedures"  (as  previously  defined)  require  a  time  step  of  the  order  of  0025 
seconds  to  give  a  satisfactory  solution. 

Figure  2  shows  that  if  a  time  step  of  0  I  seconds  is  adopted,  the  solution 
"locks'  jt  a  position  close  to  the  initial  position  after  one  and  a  quaner  periods 
Fig  3  showi  that,  prior  to  this  ’locking',  there  has  been  a  build-up  of  energy 


i  a 


m  •  lOkg 
t  •  30(,43cm 
g  •  980em/t«e2 


Fig.  1  Bathe's  pendulum 
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Tim*  {««c.) 


Fig  3  Relaiionships  btiween  energy  and  lime  for  Baihe's  pendulum 
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with  an  increasing  percentage  going  into  strain  energy  associated  with  an 
oscillating  axial  strain  (Fig,  4)  This  phenomenon  was  earlier  noted  by  Bathe  |18} 
The  term  locking  is  used  because,  although  the  bar  still  moves,  the  overall 
(lower  mode)  monons  arc  now  fairly  small  while  the  local  axial  stretching  (higher 
mode)  dominates 

it  would  be  possible  to  overcome  these  difficulues  for  this  simple  pendulum 
by  switching  variables  to  use  the  rotauon  and  stretch..  However,  the  procedure 
could  not  then  be  easily  extended  to  other  configurations  within  a  conventional 
finite  element  framework.  Before  detailing  the  theory  for  the  new  method,  we 
note  that,  for  this  problem,  it  leads  to  a  very  satisfactory  solution  with  a  time  step 
of  0.1  (Fig.  2  and  3)  and  that  even  with  a  time  step  of  0  5.  no  locking  is 
encountered  (Figs  2  and  3) 
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Wuhoul  damping,  the  cquilibnum  equations  at  the  end  of  the  step  are  given  by 


®n+l  ■  ‘'i.n+l  *  “  ‘>e.n+l  '  ° 


(3) 


Fig.  5  Two-noded  truss  element 


where  q,  arc  the  (static)  micmal 
forces.  M  i$  the  mass  matnic  and 
are  the  external  forces  Fquations 

(3)  may  be  solved  using  the 
Newton-Raphson  method  in  which  the 
lineansatton  of  (3)  is  used  to  ODtain 
the  effective  tangent  stiffness 
matnx. 

In  the  following,  we  will 
concentrate  on  the  equations  for  a 
simple  two  noded  truss  element  as 
shown  in  Fig.  5  The  external  forces 

and  the  masses  will  be  assumed  fixed 
and  related  to  the  element  thereby 
allowing  us  to  concentrate  on  the 
latter  In  these  circumstances,  with 
the  co-rotational  approach  (6), 
equations  (3)  become 


^  1 

mjdvj 

m,a, 

'n+l 

*  3t 

rtijiv. 

.(4) 


where  is  the  axial  force  (tensile  positive)  in  the  bar  at  the  end  of  the  step 
and  IS  the  unit  vector  lying  along  the  bar  (Fig  5). 

In  Ref.  (9).  Simo  and  co-workers  have  proposed  proposed  a  "mid-point 
procedure"  m  which,  for  the  up-dating,  equation  (1)  is  retained  but  equation  (2). 
which  can  be  re-expressed  as* 


=  2!“^''  <5) 

IS  replaced  by 


With  the  cnd-point  equilibrium  of  (3)  being  replaced  by  the  mid-point  cquilibnum 
of: 


®ni  "  r 


Ma^. 


®  0 


(7) 


With  the  previous  assumptions,  for  the  bar  element  of  Fig  5.  this  leads,  in  place 
of  (4)  to 


(8) 


The  key  factor  involves  the  definition  of  N-,  via  its  associated  strain.  In  Ref  (9). 
Simo  and  co-workers  obtained  the  mid-pomt  strain  directly  from  the  mid-poini 
configuration.  However,  as  illustrated  in  Fig.  6.  for  the  previous  pendulum 
problem,  this  leads  to  high  anificiai  straining. 


■mi:. 
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Fig  6  Anificial  straining  with  conventional  mid-point  procedure 

In  order  to  remove  the  artificial  straining,  m  (14.15).  the  authors  simply  redefined 
Nffl  as  a  factor  0  (which  wilt  be  defined  later)  times  the  average  of  the  axial 
forces  at  the  beginning  and  ends  of  the  step,  le.: 

N.  -  P  CN„  +  N^^p/2  .(9) 

Simo  and  Tamow  (16.17)  have  adapted  a  similar  approach  (although  without  the 
factor  p  for  reasons  that  will  be  discussed  later). 

To  complete  the  definition  of  the  the  lenns  m  (8),  the  force  m  the  bar  at 
the  current  configuration  is  obtained  via: 

Nn*l  "  N.„.,  -  -  y  00) 

With  Iq  as  the  initia!  length  of  the  bar  The  current  length  is  simply  obtained 
using: 


'n+r  ■  ’‘2l,n+l^’‘21.n.l  “  *  **21*^*^21  *  ‘*21* 

where,  for  example  d2]  »  d:  -  di  and  X|  and  Xj  are  the  initial  position  vectors 
of  nodes  1  and  2  In  addition,  the  mid-point  unit  vectcu  Cq  m  (8)  is  obtained 
as 


’‘21,n  *  2‘^‘*2l^^m 


(12) 


I 
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where  the  true  mid~poini  length.  (between  points  A  and  B  in  Fig  5)  is  given 
by 

(The  procedure  breaks  down  if  the  incremental  rotation  is  180o  when  becomes 

zero  if  there  is  no  streiching.  Such  enormous  increments  are  unlikely  to  be  used). 
The  factor  P  in  (9)  is  provided  to  ensure  energy  conservation. 

Using  (1)  the  change  in  ktnetic  energy  at  a  node  can  be  obtained  as; 

dK  =  2m(v„^,^v„^;  -  v„\)  =  mv^>v  =  ^mrSv^Ad  „(14) 

while  wiih  the  previous  assumpiions,  the  change  in  external  potential  energy  at  a 
node  1*;. 


AP  =  -  q^j^Ad 

For  an  element,  the  change  tn  strain  energy  is  given  by. 

-  N„2)  .  ^N,,AN 


where: 


AN 


T7'n+1 


'  '■n>  = 


EA  '^n+1^  ~  'a^ 


r:u. 


n+1 


(15) 


(16) 


(17) 


while 


'n.,--'n’»^*21.n'"<‘21^<4l"'>2I=^U*m'^-4l 

With  having  been  previously  defined  m  (13)  From  (16)-(1S),  wc  obtain 

dtp  =  P^v'm"^<*21 


With' 


P  - 


C. 


K. 


n+1 


(20) 


Hence,  with  the  mid-point  axial  force  being  given  by  (9)  with  p  from  (20).  the 
total  energy  change,  can  be  expressed  as 
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rfAdji 

*  AK  +  AP  =  g 


(21) 


wiih  g  from  (8).  At  equilibnum  g  is  zero  and  hence,  at  equilibnum.  energy  is 
exactly  preserved.  It  is  worth  noting  that  the  factor  p  tends  to  unity  as  the 
step-size  lends  to  zero  and  is  also  unity  when  there  is  no  rotation 
Equations  (7)-<9)  can  be  lineansed  to  give' 


=  «0.,m 


1 

S 


'mj8vj 

rTi.Sv. 


=  K,?d 


(22) 


where,  via  (1) 


K,  =  K, 


At* 


mjl 


and' 


6q 


i.m 


=  Kj6d 


.(23) 


(24) 


Full  details  are  given  in  (14).  It  should  be  noted  that  K{  is  pon-symmemc 
although  an  anificial  symmemsatton  can  be  applied  if  the  time  steps  arc  not  too 
large  (14). 

3  !  AN  ALTERNATIVE  FORMULATION 


Following  on  from  the  work  m  (16|.  Simo  and  Tamow  (17)  have  very  recently 
proposed  an  energy  preserving  procedure  for  shells.  We  will  now  attempt  to 
establish  lln^s  with  the  present  formulation. 

If  j  total  Ldgrangian  formulation  is  adopted,  equation  (4)  becomes  (6) 


®n+l  "  ^n+l^n+l 


fmiilv, 

m,a, 

‘’el 

1 
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'^2, 

(25) 


where 


"n+1 


n+1 


n+1 

®n+l 


and  in  place  of  (10). 


n+I 


EA 


2  / 


'>  2 

l'n.r  '  'o  > 


.(26) 


(27) 


Applying  the  approach  of  Simo  and  Tarnow  (I7J.  m  place  of  (8),  the  mid-point 
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equilibrium  would  ihcn  take  the  form* 


(28) 


where  K  simply  the  mean  of  the  hTs  at  configurations  n  and  n+1  (as  before 

but  with  (27)  now  defining  the  N’s).  Following  the  lines  adopted  previously,  ii  is 
easy  to  show  that  this  approach  leads  to  an  energy  conserving  algonthm.  It  can 
also  be  shown  that,  provided  the  strains  (but  not  the  deformations  or  rotations)  are 
small,  we  can  adopt  equation  (28)  for  the  present  co-rotational  formulation  with 
the  N's  being  given  by  (10)  and  that  this  leads  to  a  procedure  that  is  very  close 
to  that  given  previously.  By  comparing  (28)  with  (8)  and  (9).  it  is  clear  that  we 
merely  need  to  establish  that: 


>0 


“n+l' 


(  f-e 
rm  i  n 


(29) 


where  we  are  now  using  rhe  co-rotational  form  for  the  b  vector  (see  (4)  and  (6)). 
With  small  strains,  it  is  easy  to  establish  that  this  relauonship  does  indeed  hold 
because 


'n*l' 


nti+l/  .  n  A j  \ 


-  r^*21,n 

mav 


i<id2i) 


K 


.(30) 


4.  Numencal  Examples 

The  following  examples  have  been  computed  using  the  onginal  formulation  (14.15) 
rather  than  the  previous  "alternative  formulation".  For  the  first  set  of  examples 
which  involve  small  strains,  we  would  expect  almost  identical  solutions  via  the 
"alternative  formulation"  ^  u  j  • 

The  numencal  results  for  Bathe's  pendulum  have  already  been  desenbed  in 
the  first  set  of  following  examples.  Young's  modulus  times  the  area  had  been 

chosen  to  be  10*®N  so  that  the  bars  or  chain-links  are  nearly  agid.  In  all  cases, 
fixed  time  increments  have  been  employed  The  terminology  'Mewmark  refers  to 
the  Newmark  scheme  with  p  »  0.25  and  y  *  0.5. 

4  I  FOUR-CHAIN  SYSTEM 

Fig  7  shows  the  computed  response  for  a  four-bar  chain  of  the  same  EA 
value  as  the  previous  pendulum  and  of  total  length  4(X)  which  is  free  to  fly  (in 
ihc  absence  of  gravity)  The  chain  was  given  an  initial  linearly  varying  downward 
velocity  which  was  zero  at  the  nght-hand  end  and  was  equivalent  to  a  rotation 
about  the  nghi-hand  end  of  I  rad/sec  The  density  was  taken  as  I  Kg/m 


205 


The  response  for  ihe  present  method  luvolves  the  cnain  remaining  straight  as 
It  should  In  contrast  the  Newmark  method  (with  P  »  1/4,  y  *  1^)  stans  by 
giving  a  sensible  solution  but  suddenly  jumps  to  a  false  tnergy  configuration  (Fig. 
S)  associated  with  axial  oscillation  of  the  bar  and  no  overall  rotation  (Fig  7)! 

The  solutions  in  Fig.  7  arc  related  to  a  fixed  time  increment  of  0.1  secs.  They 

arc  compared  with  the  exact  solution  for  the  horizontal  tip-displaccmcni  at  the 

left-hand  end  in  Fig.  9  The  "exact'  tolution  »s  computed  by  assuming  that  the 

bars  are  ngid  it  can  be  seen  that  the  present  meuhod  leads  to  an  effectively 
exact  solution  with  At  =  0  1  while  even  with  At  =20,  although  there  is  some 
penod  elongation,  no  "locking"  occurs.  The  present  method  not  only  conserves 
energy  (Fig.  8)  but  also  angular  momentum  (14). 


■■  .  Sxttct  *  Nawmork  4t*0.  1 

®  dt'O.t*  Present  4t*2. 0 


0.0  2.00  4.00  6.00  6.00  m.O  12.0  14.0  16.0  18.0  20.0 


Tin*  ii*c.  ) 


Fig.  9  Relationships  between  tip-dispUcement  and  time  for  frcc-flying 
four-bar  chain 


4.2  SIMPLE  MODEL  WITH  TWO  DEGREES^F-FREEDOM 

The  first  author  and  co-worker  have  desenbed  (19.20)  an  energy  framework  for 
the  simple  model  problem  shown  in  Fig  10  The  bar  OA  is  modelled  with  one 
of  the  (ru^s  elements  discussed  previously  while  in  the  x-direction  a  linear  spnng 
of  Stiffness  K  is  provided  (AB  being  forced  to  remain  honzontal)  The  point 
mass.  m.  was  set  to  unity  .  the  initial  length.  to  100  and  Young's  modulus 
times  the  area  of  the  bar  OA  was  set  to  5w  so  that  the  stiffness  of  the  bar  was 
5  0  which  IS  five  times  larger  than  the  stiffness  provided  for  the  linear  spnng,  BA, 
for  which  K  =  1  No  gravity  effects  were  considered 
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The  energy  framework  can  be  used  to  show  ihat  if  the  initial 
non-dimensional  kinetic  energy,  t  =  2V(K(^^),  is  greater  than  the  a  cntical  value 

Tc,  *  0.833  the  system  mav.  within  a  cenain  time  penod.  "escape"  from  a 
response  associated  with  a  low  ampluudc  so  as  to  respond  with  a  ‘large 

amplitude".  However,  if  t  <  Te,,  such  "escaping  motion"  should  be  impossible 

For  the  present  study.  has  been  set  to  08  with  the  angle  a  in  Fig.  10  being 
I35o. 

Figure  1 1  shows  the  computed  relationships  between  the  the  venical 
displacement  (y  direction  -  Fig.  10)  and  time.  As  anticipated,  with  the  present 
method,  the  motion  does  not  "escape"  (Figs.  11  and  12a).  In  contrast,  with  the 
"Newmark  method",  escape  occurs  after  about  30  seconds  (Figs.  11  and  12b).  The 
latter,  false  response,  is  very  similar  to  the  true  response  which  mignt  have  been 

obtained  with  an  initial  kinetic  energy,  t  >  Icr  (see  (19.20)). 


Fig.  10  Simple  model  with  two  degrees-of-freedom 


5.  Extensions  to  Other  Types  of  Element 

The  extension  of  she  previous  formulation  to  cover  three-dimensional  truss 
elements  is  tnvial  Indeed  the  basic  equations  remain  unaltered.  In  the  following, 
we  wdl  initially  outline  a  possible  extension  to  cover  two-dimensional  beams 

The  equivalent  static  formulation  is  detailed  by  the  author  in  (6)  and  is 
closely  related  to  the  work  of  Oran  (21).  It  is  based  on  a  Kirchhoff  beam 
formulation  without  shear  deformation  although  an  equivalent  formulation  bssed  on 
Timoshenko  theory  can  easily  be  derived  (6)  In  relation  to  Fig.  5.  we  again  have 
two  nodes  but  now  with  a  rotational  vanable.  6  added  to  the  two  translauonal 
vanables.  d  at  each  node  Collectively  the  structural  "displacements"  arc  then 


Y  41 splac*ffi*nt 


Fig.  11  Relationships  beiween  venical  displacement  (y)  and  time 
for  simple  model 


. . .  »«»"•»  N.™.rSd,.0.1  SCO.t.d. 


Fjg.  12  Traces  of  motion  of  poim  A  for  simple  model 
a)  Present  solution  b)  Solution  via  ''Newmark'* 


(31) 


=  (dj\  8j.  (U,  6,) 

For  ihe  bending  deformations,  we  require  two  local  rotations. 

=  6j  -  a  ;  0^  a  ©2  "  ®  •  (^2) 

where  ct  is  the  rigid  body  rotation  which  at  configuration  n+l  can  be  computed 
from’ 

where  the  lengths  (q  (initial)  and  (current)  follow  the  same  equations  as  used 

for  the  truss  element  (see  (U))  It  should  be  noted  that  the  curved  length 
component  is  neglected  in  this  baste  formulation  It  is  perfectly  possible  to  add 
additional  terms  to  allow  for  these  effects  (6)  via  rotating  "shallow  arch  terms" 

The  local  bending  momerns,  Ivli  and  Klj  arc  computed  from  the  local  6's 
via: 


For  the  following  dynamic  formulation,  we  require  a  good  approximation  to 
(33)  that  IS  valid  for  the  change  of  ngid  body  rotation  between  configurations  n 
and  n+l  Such  an  approximation  follows  from  Figure  13  and  is  given  by: 


Fig  13  Computation  of  the  ngid-body  rotation 
The  axul  energy  for  the  beam  clement  follows  identically  that  given  previousl>  for 
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ihe  truss  and  hence  ^e  wjH  conccmraie  on  the  bending  energy  For  the  latter,  the 
static  internal  force  vector  is  given  by  (6) 


“'i.n+l  ■  ®n+I 


where  the  "B  matrix  is  given  by 
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If  we  now  adopt  the  average  B  mamx  approach  of  Simo  and  Tamow.  wc  amve 
at  the  following  mid^point  dynamic  equiUbnum  equations 


«  =  N  Ub  ♦b  ,1  ♦  Ud  +  B  ,1 

*m  av  21,  n  n*lj  n  n+lj  M  , 


fm|Av| 

+  L  .0  ,0  .(38\ 

Si  mjSvj  ^.m 

where  we  have  also  adopted  the  average  B  approach  for  the  axial  part  (see  earlier 
section  3  1)  so  that  the  b  vectors  would  be  as  given  in  (29)  The  lii  terms  in 
(38)  involve  the  "lumped"  rotational  mass  while  ihe  term  I  is  simply  the 

average  of  the  M  values  from  configurations  n  and  n+1  (following  N,,  -  see 
(16)). 

The  lime  integration  of  the  rotational  variables  follows  ihe  same  form  as  that 
adopted  for  the  translations,  i.e.. 

»n.l  =  Si''®  -  ®n 

»m  =  Si^^  <^®> 

To  consider  the  energy  conservation,  wc  firstly  supplement  the  axial  strain 
energy  of  (19)  with  the  bending  strain  energy 

AiPb  =  Mav.l''®,'!  "  '\v,2‘'®(2 


L 


(41) 


where  the  rjgid  rotanon  Aa  is  given  by  (35).  In  addition,  for  any  node,  we  have 
a  contribution  to  the  kinetic  energy  of. 

ATjj  =  =  i^.AdAe  (42) 

where  we  have  used  (39)  Combining  (41),  (42)  and  (35)  with  (14).  (15)  and  (19) 
leads  to  the  relationship' 

AO  ■  Atp  >  AT  +  AP  »  ■(‘^3) 

where  is  the  residual  term  given  by  (38)  and  Ap  contains  the  incremental 

nodal  “displacements".  As  with  the  truss  formulation  the  change  of  energy  in  (43) 
will  theretore  be  zero  once  we  have  iterated  to  the  state  where  the  residual  in 
(38)  IS  zero 

In  relation  to  static  analysts,  the  author  has  extended  the  two-dimensional 
co-rotationai  formulation  to  three-dimensional  beams  (22)  and.  in  future  work,  it  is 
intended  to  ufply  a  similar  approach  to  the  dynamic  case.  The  extension  to 
dynamics  will  also  be  applied  to  a  simple  cofoianonal  tnangular  shell  element 
(13).  If  (he  formulation  is  resmcied  to  small  strains  (although  with  large 
deformations  and  rotations),  the  simplest  approach  would  be  to  adopt  the  method 
based  on  the  averaged  B  matnx.  For  the  shell  element  of  (13).  which  has  only 
one  rotational  vanable  per  each  mid-side.  the  resulting  formulation  should  be  very 
simple. 


6.  Conclusions 

An  energy  conserving  time-intcgraiion  procedure  has  been  devised  that  is  based  on 
the  co-roiaiional  approach  and  involves  a  mid-poini  configuration  in  conjunction 
with  averaged  strains  Examples  have  been  presented  showing  the  application  of 
the  technique  to  simple  two-dimensional  truss  elements.  It  has  been  shown  that 
‘'conventional  techniques"  lead  to  solution  that  may  suddenly  jump  to  higher 
energy  states  that  are  associated  with  high  frequency  axial  osculations 
Alternatively,  they  may  exhibit  false  "escaping  motion"  that  should  be  associated 
with  a  structure  subject  to  a  higher  inina!  kinenc  energy  In  contrast,  the  current 
solutions  remain  stable  with  large  time-steps 

A  disadvantage  of  the  method  is  that  u  involves  a  non-symmemc  effective 
tangent  stiffness  matnx  However,  this  disadvantage  should  be  more  than 

compensated  by  the  stability  of  the  method.  In  addition,  it  is  possible  to 
anificially  symmetnse  the  matrix  although  convergence  difficuUies  sometimes  result 
Although  the  method  has  so  far  only  been  applied  to  simple  elements,  the 
paper  has  indicated  possible  techniques  for  extending  the  procedure  to  other 
elements  such  as  three-dimensional  beams  and  shells  that  can  be  formulated  using 
(he  coH'otaiional  method 
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MODDICATION  OF  FLEXIBLE  BODY  DYNAMICS  USING  SUBSTRUCTURES 


STANLEY  G.  BUTTON  and  MALCOLM  J.  SMITH 
Deparment  ci  MechaMcal  Engineering 
University  ofBrUish  Columbia 
Vancouver, B.C.  Canada  VSTIZ4 


ABSTF^CT.  The  calcnlanon  and  modificadca  of  the  undamped  fiequency  chanmensDcs  of  Sme 
elemen  models  is  eonsidemd  in  the  conieal  of  componem  mode  symhesis  piocediues.  The 
appUcadon  of  the  6ee  inietface  compooem  mode  pncodure  is  examined  by  analysis  of  a  comides  3D 
model  Developments  am  presened  that  allow  slgnificamly  leduced  models  to  be  iiiiii7«t  in  the 
modificailon  of  global  fiequency  chsraeterisdcs.  The  application  of  smisilivity,  funvaid  modificanoa 
and  inveise  modifioaiiao  approaches  aie  examined. 


1,  Introdnrtion 

Analysu  of  the  dynamics  of  flexible  medaitol  systems  is  geneially  achieved  by  the  use  of  the  finite 
eiemn  mefiiod.  Such  an  approach  often  leads  to  the  development  of  a  mathematical  model  with  a 
large  number  of  degiecs  ^  fieedom.  fit  many  cases,  the  dynunlcs  of  mteren  only  involve  the  lower 
modes  of  vibradoo  snd  in  such  cases  die  ap|iicadco  of  cooipaira  mode  synthesis  pnnapies  to  the 
model  may  be  advaniageoux  In  ddsappro^  the  overall  mooel  is  viewed  as  a  senes  of  componenis 
with  vancus  mediods  having  been  proposed  for  idrahnng  the  behaviour  of  each  component.  The 
overall  aim  of  the  procedure  <s  to  romponent  r^odes,  that  serve  as  basis  vectois  for  the 
dispiac-finaits  of  each  componisti.  and  a  syuAesis  pcocediro  that  can  be  used  to  couple  the 
componert  equadnns  itao  a  global  repeesmadon  of  the  synen  being  modeled.  The  benefii  of  this 
procahue  is  that  the  resulting  egiitdont  contain  far  fewer  vaiiables  than  the  oiigmal  model  but  by 
proper  choice  of  component  repcesentanon,  die  reduced  model  can  accurately  piedia  the  lower 
fiequency  diaragentdct  of  the  original  sysam.  Funber,  should  design  modifications  be  lequiied, 
only  the  charicteritiics  of  specific  componoss  may  need  to  be  rtianged  and  substannal  time  savmg 
can  be  effected  in  the  re-analysis  process.  Such  procedurea  thus  allow  the  posribility  of  more  design 
altemadves  to  be  reviewed  in  a  gneo  tune,  thus  mcreasmg  the  chances  of  an  cpumal  design.  Indus 
context  it  should  be  lemadced  that  the  availabihty  of  reiattvely  ffst  procedoics  that  assist  m  the 
(fcsign  stage,  even  though  they  may  sactdfioe  aome  accKtacy,  can  be  veiy  useful,  given  dre  fact  that 
the  analysts  can  always  reson  to  a  detailed  finite  elemea  model  as  a  final  check.  It  is  with  this 
philosopiiy  in  imnd  that  some  of  the  developments  m  die  paper  are  presented. 

In  the  piesem  snidy,  attennoo  is  confined  to  the  detetmniaiino  of  the  modal  cbatactensucs  of  linear, 
undamped,  noo-gyroscopu;  vib’unng  systems.  In  this  context  the  purpose  is  to  illustrate  how 
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componenc  mode  syiubesLs  proceduiee  cen  be  onb7ert  in  tbe  analysis  and  modificanon  of  finite 
element  models. 


2.  Component  Mode  Synthesis 

Hie  pioblem  to  be  consideied  is  the  deteiminatton  of  the  flee  vibtaiion  chaiacteiistics  of  a  system 
that  can  be  ceptesented  by  a  global  equanon  of  motion  of  the  fonn 

Mu(t)  +  Ku(t)=/(t)  (I) 

where  M  and  AT  are  real  symmetnc  mass  and  aiSacsi  manices,  u  is  a  vector  of  tirae  dependent 
genetabied  displioements  and/  a  vector  of  apphed  forces.  InjeneiaLMispoemvedeSimeandAris 
riiber  positive  definite  or  pc^ve  semi'de&tiie,  depending  upon  whether  rigid  body  morion  is 
possible. 

1111:  philosophy  of  component  mode  synthesis  Is  to  consmict  an  alieinanve  global  eqiuiion  that  is 
dnenninfid  on  the  basis  of  modal  and  response  chaiactensccs  that  are  detensined  for  individiial  sub- 
stnictures  or  componems  of  the  global  system.  Reviews  of  component  mode  reprsentaiion  have 
been  given  by  Httny  (1],  Kubomuta  (21  and  Craig  (3).  Smith  [4]  has  presented  an  i.valiiaiion  of  the 
appUcaUllty  of  such  methods  for  modsl  analysts  of  finite  elcmem  models. 

The  fine  vibration  equations  of  motion  foimulaied  by  componem  mode  synthesis  m  its  most  geneial 
fomi  may  be  written  as; 


k  Si  ^  =  0 


(2) 


where 

KsTHTT  and  U  =  T'’1a  T 

r  s  the  trattsfotmauoo  fiom  the  physical  cconhnates  of  the  components  u  to 
the  generalized  cooTdmaies  of  the  system  4  ■  T  thus  depends  upon  the 
CMS  procedure  used. 

IT,,  'M'  -  blooit  (hagonal  matrices  coniaiiiing  the  snffiiess  (mass)  matiu  of  each 

componem  written  in  teinis  of  physical  coonhnaies  u. 

In  this  paper  a  fiee  mtetfiKC  method  is  used  in  winch  txanposienis  are  represented  by  low  fiequency 
fiee  vibration  modes  and  residual  fleaibilities  of  the  neglected  high  fiequency  modes.  For  this 
method: 
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where 

<t>  =  block  dugoiul  mamx  eech  component  of  which  conuins  ihe  free  fire 

modee  utcd  in  tfm  component  represenunon 

=  block  dihgoiul  menu  each  compcnent  of  which  cciuains  die 
components  of  the  free  free  modes  used  that  cotrespond  to  the  mtei&re 
■ocancn  of  that  component 

'ijr  =  block  diagooal  manix  each  component  of  which  contains  the  residual 

attachment  modes  used  in  that  component  lepiesenianon 

ip  ®  «  similar  to  d>  ® 

A  s  matnx  defitiUig  intercomponem  compantUiiy  and  eqtiilibnum  con- 

stramt; 

p  =  genenitzed  cooiduiates  of  the  global  model  coniainmg  m  sequence  the 

magnitude  of  the  conmbuuon  of  each  compcnem  free  mode  to  the  global 
response. 

As  an  example  of  the  use  of  such  CMS  pcocedures,  ccnsideT  the  analysis  of  the  stnictuie  shown  in 
Figure  1.  The  snucture  in  quesdon  couists  of  a  telescope  focus  unit  that  is  supponed  above  die 
mam  minor  by  latticed  misses.  A  detailed  analysia  of  ddt  stnicnice  was  imdenakm  by  Smith  (4] 
using  both  bee  interface  and  fixed  hnerbce  CMS  foimulailons.  The  ccanpleie  system  was  analy^ 
in  lemis  of  five  compcnenB  that  described  the  body  of  the  focus  unit  and  four  components 
representing  each  of  the  legs  Table  1  summadzes  the  results  of  three  differeiit  analysis  usmg  die 
same  componem  modes  but  where  the  hl^iest  fiequency  retained  in  any  component  was  tespecnvely 
30. 90  and  ISO  Hz.  Table  1  also  compares  the  resulting  calculated  nai^  fiequenoes  for  the  lowest 
40  modes  of  the  system  for  each  diffeiCT  case  with  the  results  of  a  globed  finue  element  mcdeL  Also 
ccmpaied  are  the  number  of  degrees  of  fieedom  that  are  involved  in  each  represeniafioa 

The  first  pomt  to  note  la  the  degree  of  condensaiioa  that  is  obtained  by  the  piocedure.  the  nuffiher  of 
degrees  of  fieedom  are  reduced  fiom  33fi0  to  either  46.  62  or  78  depeni^  upon  the  canpcneffl 
mode  frequency  cut-off  used. 

The  CMS  results  for  the  30  Hz  componentcut-off  prethato  an  accuiacy  greater  than  S%  all  gk  oal 
modes  below  33.S  Hz.  (or  90  Hz  cut-off.  all  global  modes  below  98  Hz.  and  for  ISO  Hz  cut-off  die 
lowest  40  fiequendes  are  calculated  to  lesa  than  1%  enor. 


TABLE  l.commued 


Mod9 

FnquMcy 

30  Hz 

90H2 

130  Hz 

23 

839 

700 

060 

•0.10 

24 

840 

206 

0.75 

004 

25 

856 

225 

1.38 

0.04 

26 

857 

232 

283 

-0.02 

27 

98.1 

375 

7.21 

0.02 

28 

99.0 

391 

957 

0.25 

29 

997 

537 

9.63 

019 

30 

1040 

578 

8.10 

0.03 

31 

104.1 

670 

12.0 

024 

32 

104.3 

943 

122 

031 

33 

105B 

1018 

103 

0.07 

34 

117J 

964 

194 

02Z 

35 

117.S 

1000 

194 

0.29 

36 

1177 

1043 

52.3 

038 

37 

120.1 

1072 

49.7 

043 

33 

125.5 

1334 

443 

0.10 

39 

127.4 

1366 

785 

0.97 

40 

1336 

1453 

9^6 

0.00 

*dof 

3330 

46 

62 

78 

Thus,  usmg  CMS  proonluRS.  it  is  possible  to  slgnificsnly  reduce  the  number  of  degrees  of  fieedon 
as  well  as  subdivide  die  global  stnicture  into  subsQuctures  that  may  allow  future  modificanons  to  be 
accompiisbed  more  eCBdently.  For  examine,  if  die  lequued  modificatioii  only  involves  spedfic 
componenia.  then  u  is  not  necessary  to  reccopute  die  cbaraoerisiics  of  die  unmodified  companaus. 
This  can  lead  10  substantial  time  savings.  In  the  telescope  focus  umt  analysis,  die  effect  of  changmg 
the  snfBjess  of  die  beaimgs  between  the  inner  and  outer  tubes  of  die  focus  umt  was  uivesugated. 
Modificanon  of  this  snffiiess  and  re-analysis  of  die  ccmpleie  pioblem  took  22%  of  tbe  time  requued 
for  the  baseline  CMS  analysis.  Thus  in  situancos  where  many  such  re-analyses  have  to  be  computed 
m  order  to  obtain  a  system  with  the  desired  respmse  cbaractensncs,  die  benefits  of  usmg  a  CMS 
procedure  may  be  sigmficanL 


3.  FVequencj  Modification  Procedures 


When  faced  with  tte  task  of  modi^ing  die  vibration  duractensdcs  of  a  system  to  meet  specified 
response  cniena.  often  it  is  the  location  of  system  namral  frequencies  with  respea  to  applied  forcing 
frequencies  that  is  of  inietest  Thus  a  comfflOD  requirement  is  that  of  modifying  modal  charactensncs 
ini  some  preached  manner.  Procedures  available  for  the  purpose  have  been  reviewed  by  Baldwm 
and  Hutton  (5].  S6<alled  '*forw^  modificarinn  procedures'*  involve  specifying  a  physical  change  to 
die  model  and  ^pudng  the  resuldog  modal  effect  Such  procedures  may  require  a  number  of 
ttgfarifms  to  acUeve  a  sadsfaccoty  mortifirarion.  Inverse  modtficadoo  procedures,  on  the  other  hand, 
specify  as  irqnit  the  required  mo^  modiflcsfiong  and  the  output  ftom  the  algonihm  is  the  required 
modificadoQS  to  the  system.  Such  Tnodiflcarion  should  be  expressed  in  terms  of  parameters  dial  can 
be  physically  dianged  such  as  plate  thicknesses,  or  beam  seamd  moments  of  area  as  opposed  to  the 
elem^of  dK  mass  and  macnees  which  then  require  further  inierpietanoa  inm  appropnatt 
physical  van  aMn 

In  the  case  of  fimte  elemen  analysis,  it  is  coivemea  to  define  modificanon  of  the  soffiiess  mamx. 
for  example,  as 


AK  =llAj{k,)jAtaf  (4) 

«/■! 

wben  ibe  modificinon  of  d)e/*>  dedgo  puimeter  mults  in  a  change  in  the  clemea  siiShess  cf 
Ibe  matrix  jt.repieaena  the  tiansfhnnatioa  between  elanem  and  global  cootdinaua  ID  the 
Sine  clemea  model  A  smilar  eiguiiaa  can.  of  coiuse,  he  wnnen  for  maas  matiu  modtScanon  m 
terms  of  clemea  mass  sensidvity  matrices  (m^j.  If  the  elcmea  sdfbiess  and  mass  sensmvity 
matrices  are  Indepealea  of  the  dalgn  parameter  a.  then  the  modificauoa  is  teimed  linear,  changuig 
mass  density  or  Voting's  Modulus  astilia  m  linear  modi  ficaiiaw.  Changmg  die  thickness  of  a  plate  is 
a  linear  change  for  a  membrane  elemea  but  a  non-linear  change  for  plate  bending  elemmi,  Ii  is 
possible  to  approxunaie  oon-linesr  modifications  as  linear  if  the  change  m  die  design  parameter  is 
suffiaendy  small  In  the  piesemworii.  all  changes  will  be  assumed  linear. 

3.1  SENSmVnY  ANALYSIS 

CeiKtal  idgiimnr.  of  sensinvity  mabods  m  structural  dynamics  have  been  presented  by  Adelnun 
and  Hafdu  [6],  and  Biandcn  (71.  Ihc  banc  senamviiy  equanons  were  denved  ongtnally  by 
Lancaster  (8),  and  Fox  and  Kapoor  [9|. 

Ibe  senstdvuy  of  d»  eigenvalue  to  a  chmge  m  the  design  parameter  r  IS  given  by 


tT  3K  ,  3M  . 
3r  °  ^'[ar  'arf' 


15) 


1 


( 

( 


i 

! 
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where  K  =  T^k^T,  M  =  tT^  T  and^-'^^M  T^,  =1.  In  general  the  rare  of  chan^  of  7 
with  respect  to  r  cannot  be  evaluated  direcdy,  and  thus  this  fonnula  cannot  be  used  directly  for  CMS 
models.  However,  it  is  beneficial  to  consider  circumstances  in  which  7  can  be  considered  mvanant 
with  respea  tor.  Changes  linearly  propomonal  to  the  global  mass  mativt  M  fall  into  this  category 
when  using  the  free  interface  method  Under  fiiesecondiiions,  equation  (5)  can  be  written  as 


Uriortunately  equation  (6)  is  of  limited  value  m  that  it  is  in  the  sensmvuy  of  the  frequency  to  a  local 
change  m  a  component  that  IS  of  inieresL  Assume  that  7  can  be  considered  mvanant  with  respea  to 
r.  then  equatian  (t)  can  be  wntien: 


d  K  .  dM 


UTmd  K  and  M  are  wiittoi  in  terns  of  (heir  compooemcanaibudons 


dr  ,.i  ‘ 


(7) 


(S) 


where  T 


Til 

i 


LTn 


K=  diagonal  [K„K2...Kn] 
and  Ns  total  number  of  components. 


llius,  ($)  provides  infotmatioo  as  to  which  component  is  most  sensmve  m  modifying  X, 

vvtai  design  parameter  r  IS  changed  Although  no  mathemancai  proof  of  the  validity  of  equatuai  (7) 
has  been  peeseoied  under  some  orcumsufices  it  may  be  a  useful  a^^voxunanmi.  For  example,  if  the 
component  free  vibration  and  residual  aQachmezs  modes  are  lodepoidas  of  r.  then  (7)  IS  valid  Thus 
it  may  be  assumed  that  for  changes  that  do  tax  violate  this  coodmon  mo  greatly,  the  resultmg 
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sensidvuies  will  have  some  validity,  la  geoenl  the  use  of  equa&ca  (8)  should  be  confined  to 
investigadiig  which, compooeni  is  a  candidiie  for  modificatioD  rather  than  anempcng  to  use  the 
senfitivity  to  i»edict  the  reqinitd  change  in  the  design  parameters. 

As  an  of  the  use  of  equation  (8).  foe  sensinvities  of  foe  lOfo  and  1  Ifo  natural  frequeitties  of 
foe  model  shown  in  Hgure  1  are  evaluated  with  respea  to  changes  m  density  and  Young's  Modulus. 
llK  results,  which  are  shown  in  Table  2,' indicate  that  fflodificadon  of  these  modes  IS  most  effectively 
done  by  foe  of  foe  chopping  niechani.qn  and  foe  Young's  Modulus  of  foe  inn^r  mbe. 

In  subaequem  a  more  exaa  procedure  will  be  utilized  to  decnume  foe  magntT^tfW>  of  ihe 
modUScadont  leqidied  in  order  to  piofoice  a  specified  change  in  frequency. 


TABLE  2:  SendtiTity  of  Eigenvalues  to  Component  Denrftks  and  Young's  Modulus 


CompoiMflt 

P  SX,i) 

E 

X20  9E 

P 

x„  as 

Xjo  3p 

Xii  9p 

InnarTubo 

•.053 

.111 

-.053 

.139 

OularTubo 

•041 

.024 

-.039 

.027 

Screw  AiMmMy 

•.002 

.003 

•  001 

.003 

Chopping  Moehannm 

-424 

.002 

•  457 

003 

Support  Tube 

•062 

.005 

-.058 

.002 

3.2  FORWARD  MOOIFICAHON 

TTk  global  equatioo  of  modon  for  foe  CMS  model  ts  gives  in  equadoo  (2)  and  when  wnoen  in  terms 
of  foe  assembled  oompooeotstiffoess  IT  and  mass  matru  M  is.  for  foe  mode 

T’'Trr§,=x.r’^7?i  (s>) 

where  tte  mode  Shape  defined  m  assembled  pfaystfal  ooordmates  uj  is  given  by 

«/=7^,  m 

Consider  now  foe  effect  of  modifying  tl»  soffit  and  mass  charactensncstrf  this  model  Ihetaskis 
to  detemune  foe  new  mode  shapes  without  having  to  recalculate  T  and  condua  a  com(toe 
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analy^  of  the  modal  Assume  that  the. new  modes  in  physical  coordinates  can  be  suffioently  well 
^^rommated  by  a  linear  combinaiion  of  die  calculated  modes.  i.e.. 


=  i,c„u,  =  ic*Tl,  =  TZCi  (II) 

wlKicZiiamffiuofitiebuduiemocks^j.aixlCjisaveaorofcoanamstobedetaDiised  Under 
the  consirauus  imposed  by  (11).  the  reniliin;  equadoos  of  modon  for  a  new  system  with 
modificadons  defined  by  A  K  and  AM  aregivenby 

T’'[Tr+aT-X'iCM+A‘M)]T5,"  =  0  (12) 

whete  the  modified  mode 

«;•=  TZc,=  Ti\ 

OiHe  r  has  beco  calculated,  equatkn  (13  affords  a  conveniea  and  rapid  afpnach  to  dcteimmmg  the 
efTectofartniiaiy  changes  A  K  and  A  M  to  the  baseline  modes. 

Using  the  forward  modiflcatloa  approadiea  outlined,  Uis  potaible  to  signiScandy  reduce  the  order  of 
complea  fimte  clement  inodela.  Although  in  some  cases  the  abaoline  accuracy  of  the  analysis  may 
not  be  known,  the  ability  to  invesdgaie  a  laiger  number  of  modification  altenuuves  may  be  mote 
impoitauL  A  final  fiiUfinim  element  R-analysis  would  generally  be  conducted  in  such  cases  to  venfy 
the  accuracy  of  condeosanaa  adopted. 

As  an  Ulustiailoo  i-f  the  use  of  equaucn  (12),  consider  the  effect  of  dunging  the  materisl  of  the 
component  lepresemiag  tbe  chopping  mechauLm  Ciom  alumirnim  to  steeL  As  this  compcneix  is 
elfecavely  ri^  Ifaia  change  u  eaenilaUy  a  pure  mass  change.  Hguie  2a  show;  the  results.  Use 
ftKjuaides  of  the  aluminum  baseline  modea  are  shown,  as  art  the  modified  fieqiiendestatailiied  by 
equanoo(12)andrefBiiedtaastbelliiearequivalentanalysU.  A suhaequen: complete OtlS analysis 
of  the  steel  case  gives  eaacily  the  same  results  as  lb:  linear  eqidvalesu  analysts. 

Hguie  2b  shows  tbe  results  of  a  second  analysis  m  whicb  die  modificatioa  again  uivolves  changing 
the  maierial.  for  Ifae  component  lepresenimg  die  inner  tube,  this  lime  fiosTisael  to  alumimif  a.  Indns 
case,  the  modificaiion  affects  the  dynamics  both  duoughlhesdffiiess  and  the  mass  matncti.  Asmay 
be  seen,  the  linear  equivalent  re-analysis  gives  results  close  to  thoae  produced  by  a  complete  CMS  le- 
analysis. 

In  both  examides,  tbe  use  of  the  hnear  eqmvalent  analysis  results  in  coosideralde  nme  savmgs 
compared  to  a  CMS  re-analysis. 


3.3 


INVERSE  MODinCATION 


Inverse  Modification  techniques  based  on  iineanzed  penuibaoon  equaoans  weit  first  developed  by 
Stetson  (10].  Subsequently.  Hoff  et  cd  (11)  develop  a  predictor-contcior  algonibm  using  both 
linear  at^  general  peituibaiion  equatians  for  unsubsirucmttd  synems.  In  a  recent  paper  by  Smith 
and  Hutton  (12),  a  new  fonnulati^  of  the  pereirbaiioo  equancns  for  inverse  firequeocy  mod^canon 
is  presented  which  retaias  all  norhlinear  coupling  terms  and  is  efi’ective  for  l^rge  fitquea^  changes. 
The  foUowuig  discusses  the  ^ipUctaon  of  this  fonnulason  to  CMS  motkls. 

Assume  that  it  is  requhtd  to  modify  the  dynamics  of  a  model  such  that  X; »  by  varying  a  deagn 
parameter  where  the  fiacQonal  change  m  this  parameter  is  denoted  by  a. 

In  general  die  trutsformaiiaa  7*  will  be  ac  unknown  function  of  the  change  cl  However,  by 
computing  all  the  baseline  modes  and  utiliaing  equation  (11).  one  can  wnte 

(A+Z^7^4'K(a)7z)c,  =X",(l+Z’'r’'A'Mfo>rz)cj  (13) 

where  A  Is  1  dUgoul  matrix  of  the  bcxlloe  agenvaluea  and  the  Z  mamx  has  been  nonnalized  such 
thatZ’'r’lr  TZ  =  / 

If  A  K  and  A  M  are  reacicted  lo  be  linear  fimctlais  of  a  and  there  are  m  such  design  vaiiahlcs. 
then  equadon  (13)  may  be  wriiien 


&' -X)W)ZTc,  =(\-X]l)c,  (14) 

f  1  ' 

.vhere  ,  Mj  m  global  matrices  repreaeming  the  soffitess  and  mass  senanvuies  to  the  desgn 

variable  ctj.  Equatton  (14)  is  dttia  a  system  of  equancns  whoee  order  is  equal  to  that  of  the  CMS 
model.  If  there  are  multiple  bequency  consiraiiiis  then  these  are  as  many  sets  of  (14)  as  diere  ue 
bequenty  cocsiniiD.  TOa  equation  has  the  same  farm  as  tins  for  unsubemictuitd  models  and  can 
be  solved  in  the  aame  manner. 

Ifffl  is  equal  to  one  and  there  IS  only  one  bequeacyconioiiat.  an  eigenvalue  problem  restUis  with  the 
egenvalues  repreaeming  the  ebange  Uj  and  the  dgoivector  Cj  (jgmmnf,  dUDugh  the  us.s  of  (I  I), 
the  modified  ogenveaorUj  .  In  tbe  more  genenl  case  wtam  dr  number  (ri  design  variables  exceeds 
die  number  cf  fiequency  conatraints,  an  iterative  sohidcn  may  be  used  (12). 

As  an  appUcanon  of  equation  (14),  the  bacoonal  change  in  the  density  of  the  chopping  mechanian  of 
the  model  was  calculated  in  order  to  recbice  the  fiequency  td  the  Khb  mode  boiu  39  Kz  to  35  Hz. 
Hv  resulting  value  of  a  was  1.37,le.,(bedei!Sitysnouldbeinacasedbyafactorof  Z37.  Usingihe 
same  bequency  specificastoo  but  allowing  two  design  values  aj,  cenrepondmg  to  the  densny  of  the 
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chopping  medunism.  and  0C2.  corresponding  to  the  Youngs  Modulus  of  the  inner  tube,  gave  values 
of  Qj  s  1.07  and  02  -  *0.47.  Table  3  presents  a  companson  of  the  baseline  frequennes  and  the 
hequenoes  resulting  fit3m  the  modifications  indicated  and  shows  that  the  requited  to^uency  shift  has 
been  obtained 

It  may  be  noted  that  in  the  case  of  die  mass  modification,  the  magmiude  of  the  density  change  is 
much  larger  than  would  have  been  expected  fiom  the  senstivity  result  quoted  in  Table  2.  Thisisdue 
to  the  that  the  sensitivity  calculated  at  39  Kz  is  not  valid  at  35  Hz.  Recalculation  of  ite 

sensitivity  of  the  chopping  mechanism  of  35  Hz  gives  070.  Thus  ti*  mode  shapes 

XfO  dp 

have  been  $0  mortified  as  to  change  significantly  the  effea  d  different  design  parameten  upon  ^ 
system  fiequenoes.  TUs  result  emphasizes  the  limited  value  of  the  sensitiviiy  analysis. 


TABLE  3i  Modifleadon  of  Tenth  Natural  Frequeacy  Using  Perturhadon  Analysis 


OMWlly  MadHIetlton 

Modt 

Ff$qimcy 

Mmwu/ 

Fnqu0ncy 

XChtmgt 

Danalty  ane  Uedului 
MedHleatten 


tMHM  ^ 
Fwowflcy 
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4.  Siiiiiniai7 


In  the  design  of  flexible  stmctme.  espedsUy  those  that  are  modeled  with  laige  otder  finite  element 
repiesenunons,  the  availability  of  analysis  piocedures  that  can  provide  rapid  evaluanon  of  (Meiem 
d^gnmodificatiCRS  is  desirable  Re-nmning  the  baseline  fimte  element  model  is  not  economical 

In  the  pRsent  paper,  procedures  have  been  presented  which  ufllize  the  pnnaifles  of  componera  mode 
syntbeks  to  provide  the  designer  with  the  ability  to  efSdenily  assess  the  effect  of  piescnbed 
modtflcatians  or  to  compute  the  design  changes  requited  in  order  to  achieve  a  desued  flequency 
modiflcatian  in  the  smicture.  Examples  have  been  presented  for  a  comifiex  thicodimensiooal  finite 
element  model  that  illustntes  the  efficiency  of  the  methods  desciibed 
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VALIDATION  OF  F1EXIBI£  BEAM  ELEMENTS  IN  DYNAMICS  PROGRAMS 
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A  sp&ti&l  beam  element  for  static  and  dynamic  problems  which  involve  large 
displac^ents  and  rotations  is  described.  Tins  beam  element  is  applied  to 
static  linear  buckling  problems,  the  simulation  of  the  motion  of  a  slider- 
aank  mechanism  with  a  flexible  connecting  rod  and  a  planar  and  spatial  spm- 
up  motion  of  a  flexible  beam.  Results  are  compared  with  those  from  the  open 
literature. 


1.  Introduction 

With  the  increase  of  the  speed  of  operation  and  the  required  accuracy  and  the 
tendency  towards  a  bghter  con.^truction  of  machinery  such  as  linkages  and 
manipulators,  the  influence  of  deformation  on  the  dynamics  of  mechanical  sys¬ 
tems  becomes  more  important.  The  machme  parts  can  no  longer  be  considered  as 
rigid  and  flexibilities  have  to  be  included  in  the  numerical  analy5.s  ot  the 

motion.  Especially  the  deformations  of  slender  elements  such  as  beams,  plates 
and  shells  have  a  noticeable  mfluence. 

In  the  description  of  the  behaviour  of  a  system,  one  usually  starts  from 
a  physical  model,  which  is  transformed  mto  a  mathematical  irtAlel,  in  which 
some  simplifications  of  the  physics  are  made.  The  mathematical  model  is  trans¬ 
lated  into  a  numerical  model  by  some  discretization  and  solution  process  The 
numerical  model  has  to  be  implemented  in  a  computer  program,  after  which  simu¬ 
lations  can  be  made  of  the  behaviour  of  the  considered  system.  As  exact 
solutions  for  non-linear  dynamical  systems  which  are  reiovant  to  engineering 
problems  are  hardly  known,  the  validation  of  the  results  which  are  obtained  by 
simulations  constitutes  a  non-trmai  task.  The  unplemenution  can  be  checked 

by  comparmg  the  results  from  different  independently  developed  programs  based 
on  the  same  numerical  model.  The  viUidity  of  the  numerical  model  can  be 
checked  by  comparing  results  obtained  from  programs  which  are  based  on  differ¬ 
ent  discretization  or  solution  methods  and  sometimes  from  convergence  and 

stability  theorems.  The  completeness  of  the  mathematical  model  can  be  investi¬ 
gated  by  studymg  the  mfluence  of  the  mclusion  of  some  effects  that  were 
mitially  left  out  of  consideration;  it  is,  however,  difficult  to  identify  the 
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important  effects  in  advance  A  final  validation,  an  answer  to  the  question  to 
what  extent  the  results  represent  rejdiiy,  must  come  from  a  comparison  between 
results  from  simulations  and  measurements  on  experiments. 

In  this  paper  we  restrict  ourselves  to  the  modelling  of  uniform  elastic 
beams  in  which  strains  remain  small,  but  which  may  undergo  large  translations 
and  rotations.  As  these  are  the  simplest  and  most  widely  used  slender  parts 
and  Kane  et  al.  [1]  claimed  that  some  existing  multibody  formulations  may  give 
incorrect  results,  a  detailed  investigation  into  the  modelling  of  beam's  ap¬ 
pears  to  be  important.  Firstly,  a  finite  element  for  spatial  beams  with  a 
doubly  symmetric  solid  aoss-sections  is  described,  which  is  expected  to  be 
capable  of  producing  sufficiently  accurate  results.  For  a  demonstration  of  the 
accuracy  and  the  proper  representation  of  Uie  geometric  stiffness,  the  beam 
element  is  applied  to  some  spatial  linear  buckling  problems  for  which  exact 
solutions  are  known.  The  much  studied  dynamic  problems  of  a  planar  slider- 
crank  mechanism  with  a  flexible  connecting  rod  and  a  planar  and  spatial  spin- 
up  manoeuvre  of  a  flexible  beam  are  simulated  and  results  are  compared  with 
those  from  the  literature.  In  the  last  example,  it  is  shown  how  some  aspects 
of  beams  with  a  thin-wailed  open  cross-section,  such  as  constrained  warping 
and  the  eccentricity  of  the  shear  centre,  can  be  approxunately  included  in  the 
analysis 


2.  Description  of  a  Beam  Element 

In  this  section  a  spatial  beam  element  is  described.  For  static  analysis,  the 
two-dimensional  version  of  this  element  was  developed  by  Visscr  and  Besseling 
(2].  An  extension  to  three  dimensions  and  its  use  in  the  buckling  and  post- 
buckling  analysis  of  frame  vorls  was  given  by  Besseling  [3-6].  The  mass 
description  was  included  by  Van  der  Werff  and  Jonker  (7,8)  and  the  author  |9| 
Here  some  refinements  r.ddcd. 

The  finite  beexr  element  is  based  on  the  elastic  line  concept.  'Rils  meani 
essentially  that  the  beam  is  slender  and  the  cross-section  is  doubly  symmetric 
and  more  or  less  solid.  The  configuration  of  the  element  is  determined  by  the 
positions  and  orientations  of  the  end  nodes,  by  which  it  can  be  coupled  to 

and  interact  with  other  elemerts.  The  positions  of  the  end  nodes  p  and  q  are 
given  by  their  coordinates  and  x*  in  a  global  inertial  system  (0X\7}  and 
the  orientations  arc  given  by  orthogonal  triads  of  unit  vectors,  (ej,  ej,  ej) 
and  ej),  which  are  rigidly  attached  to  the  nodes,  e,  is  perpendicular 

to  the  average  cross-sectional  plane  of  the  beam  m  the  sense  of  Cowper  [10] 
and  ty  and  e,  are  in  the  directions  of  Uie  principal  axes  of  the  cross- 

section.  If  transverse  shear  deformations  can  be  neglected,  c,  is  tangent  to 

the  central  axis  (elastic  line)  of  the  beam.  The  orientations  can  be  described 
by  several  choices  of  parameters  such  as  Euler  angles,  modified  Euler  angles, 
Rcdrigues  parameters  and  Euler  parameters.  In  the  ultimate  calculations  we 
shall  use  Euler  parameters,  but  this  choice  is  immaterial  to  the  description 
of  the  properties  of  the  element. 

The  element  has  six  degrees  of  freedom  as  a  rigid  body,  while  the  nodes 
have  twelve  degrees  of  freedom.  Hence  the  deformation  that  is  determined  by 
the  end  nodes  of  the  element  can  be  described  by  six  mdependeni  generalized 
strains,  which  are  fur^'iions  of  the  positions  and  orientations  of  the  nodes. 

If  the  parameters  which  describe  these  positions  and  orientations  are  grouped 


together  m  a  vector  x,  and  the  vector  of  deformations  is  denoted  by  e  the 
deformation  map  can  be  written  symbolically  as 

I,  -  D,(Xfc).  (1) 

With  1  e  and  ig  the  length  of  the  undeformed  beam,  we  define  the  slx 

generalized  strains  as 

£i  •  nil  -  ioi  h- 

£j  «  -I.e?,  £,  m  l.ej, 

£5  -  l.ej,  c,  «  -l.e^  (2) 

These  generalized  strains,  which  may  be  compared  to  what  Argyris  calls  natural 
modes  (U),  are  invariant  under  arbitrary  rigid  body  motions  or  orthogonal 
coordinate  transformations,  so  they  truly  measure  the  amount  of  strain  of  the 
clement. 

The  dual  quantities  of  e  are  the  generalized  stresses  They  are  defined 
by  the  property  that  a.Se  represents  the  internal  virtual  work  done  by  the 
stresses  in  the  element  due  to  the  virtual  deformations  6e.  In  the  case  of 
small  deformations,  the  generalized  stresses  have  a  clear  physical  meaning.  As 
the  deformed  and  undeformed  geometry  are  nearly  the  same,  we  consider  the 
undeformed  situation  in  which  the  beam  central  axis  coincides  with  the  global 
X-axis,  and  an  equilibrium  force  system  given  hy  the  nod>*  forces  F'  and  F* 
and  the  nodal  moments  and  acts  on  the  element.  Wit*-  i  •  (F^,  M^,  F’,  M*) 
and  the  small  nodal  displacements  and  rotations  dual  to  the  forces  and  moments 
u  «  iu^,  u^  the  equilibrium  conditions  become 

m  m  f^Ui.  a  f,du,  (3) 

from  which  follows 
fk  - 

*  (“CTj,  —^3  +  Cf  ••  <74),  ■  (”^2^0* 

F*  »  <5,,  -  Ue,  -5,  f  ?,),  M’  ■  (4) 

From  this  result  we  sec  that  is  the  normal  force,  is  the  torsion 

moment,  and  and  <7«(o  bending  moments  at  the  nodes  p 

and  q 

If  bevns  are  divided  in  sufficiently  many  elements  such  that  for  each 
element  the  strains  remain  small,  the  usual  static  linear  relations  between 
generalized  stresses  and  strains  remain  valid  ano  can  be  staled  as 

a  *  Sc,  (5) 

S  -  d:ag{5„  5j,  83,  84), 

$1  =s  EA/Iq,  5)  w 
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Here,  E  is  the  modulus  of  elasticity  (Young’s  modulus),  G  is  the  shear 
modulus,  A  IS  the  area  of  the  aoss-section,  5^  is  the  torsional  stiffness,  ly 
and  Ig  are  the  area  moments  of  inertia  of  the  cross-section  with  respect  to 
the  two  central  principal  axes,  and  fy  and  k,  are  shear  coefficients  according 
to  (10).  It  is  seen  that  the  shear  aeformations  can  be  accounted  for  by  a 
slightly  modified  stiffness  matrix.  This  direct  tying  of  the  shear  deformation 
to  the  bending  by  means  of  the  statics  of  the  beam  prevents  problems  of  shear 
locking.  This  modification  of  the  element  stiffness  can  already  be  found  in 
(12].  Initial  deformations  ana  material  damping  according  to  the  Kelvm-Voigt 
model  can  be  treated  by  a  modification  of  the  stress-stram  relation  (5)  as  a 
m  S(c  «  4-  S^,  where  are  the  initial  deformations  and  i  are  the 

deformation  rates,  and  has  the  same  structure  as  S. 

With  the  element  as  desaibed  up  to  this  point,  all  geometrically  non¬ 
linear  elastostatic  problems  of  frameworks  can  be  solved  accurately  as  long  as 
the  beams  are  divided  into  sufficiently  many  elements.  Dynamics  can  be  treated 
if  inertial  terms  as  described  later  on  in  this  section  are  added.  However,  in 
dynamics,  more  than  in  statics,  it  is  important  that  one  is  able  to  obtain 
sufficiently  accurate  solutions  ^th  rather  large  elements,  because  decreasing 
the  size  of  the  elements  increases,  besides  the  number  of  degrees  of  freedom, 
the  largest  eigenfrequency  m  the  system  and  reduces  the  allowed  time  step  ut 
explicit  integration  methods.  Therefore  an  inclusion  of  second-order  effects 
in  the  stiffness  properties  of  the  element  is  valuable. 

For  the  derivation  of  the  properties  of  a  refined  element,  a  local  coor¬ 
dinate  system  is  introduced  whose  ongui  comcides  with  node  p  and  whose  axes 
are  m  the  directions  of  ef,  e^  and  A  point  r  on  the  elastic  line  of  the 
beam  is  indicated  by  the  material  coordinate  s,  0  ^  s  ^  fo>  coordi¬ 

nates  in  the  local  frame  of  reference  are  (s  +  Ug,  Uy,  v,),  where  v^,  Uy  and 
xtg  are  the  displacements.  The  orientation  (e„  Oy,  Oj)  at  a  point  on  the  elas¬ 
tic  line  IS  desaibed  by  modified  Euler  angles  (^i,  <pyy  <pg)  as 


1 

0  0 

cos^y  0  -sin^y 

COS9?, 

sin<px  0 

* 

0 

cos^,  sin'^s 

0  1  0 

-sin^x 

COS^X  0 

< 

0 

-sin'y^x  cos^x 

sin^y  0  cos^y 

0 

0  1 

cosv?yCos^,  cos^ySinv?,  -sin',5y 

-cos9xSinv>,-fsin^xSinv?yCos^,  cos^,cosv>,+sin^,^in9ySini?.  sin,9,cosipy 
sin',?,s:n^,+cos^?^uVyCos^,  -sinv?,cos^,+cos^^uVySin'p,  cosi9,cosi?y 

(7) 
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If  we  denote  a  derivative  with  respect  to  ^  by  a  prime,  the  six  deformations 
of  the  one-dunensional  continuum  are  (6) 

y,  .  (r’.r’)‘'' -  I,  Yy  “  V""''  ri  =  e.-r’, 


Kj  S  **  “C-  .€y, 

Ky  M  e,’.e,  »  -«:.eA 


(8) 


Kj  m  -ey’.e,  ■  «ye*’- 


Yjf  IS  the  extension,  Yy  and  y,  are  the  transverse  shear  deformations,  u 
the  torsion,  and  Ky  and  x,  are  the  bending  deformations. 

As  we  are  interested  in  second-order  effects,  only  terms  up  to  the  second 
order  have  to  be  retained,  while  higher-order  terms  can  consistently  be  disre¬ 
garded.  As  the  extensional  and  transverse  shear  stiffness  are  much  larger  than 
the  flexural  and  torsional  stiffness  of  a  beam,  y,,  Yy  and  y„  and  also  the 
axial  displacement  u,,  can  be  regarded  as  second-order  effects.  The  equations 
17-8)  can  now  be  expanded  as 


i  -ivl  -  iv>5  v. 

-^y 

«y 

■1 

+  9t9y  1  - 

'fit 

«z 

9y  +  9,9t  -9t  +  9y9, 

T,  »  +  Ju,'*  +  Ju/,  Ty  -  -v>«  +  y>“fy  +  “I’l 

K,  •  ip,'  -  X,  -  (»y’  +  K,  m  <p;  - 

If  we  introduce  the  linearized  strains  ^  as 

s|  .  c,  .  (ovj,  -  -«!,  4  » +  «!.  4  -  <4-  -  'i#*?  - 


(10) 

(11) 


the  non-linear  strains  up  to  terms  of  the  second  order  can  be  expressed  as 
c,  -  cl  +  ((el)*  +  (eS)*l/(21o).  Cj  -  cj  -  (el  +  el)(el  +  el)/(2;o), 
e*  *■  el,  e^  «  ej  +  elel/lo,  ej  •  cl,  c*  "  el  -  eleI//(,-  (12) 


The  displacements  and  routlons  are  interpolated  in  the  same  way  as  m  the 
linear  case  as  (d  »  s//g) 


u,  - 

Uy  -  (2e  -  {’)4  +  (-V  +  f  )4  +  (*y/(2+2*y)l(«  -  +  24’)(4  -  4). 

.  i-ie  +  4’)4  +  (4*  -  4’)4  +  l*./(2+2#.)K4  -  3{*  +  24*)(-4  +  4), 
lo9x  =  44. 

/^Jy  =  (4(  -  3^4)4  +  (-24  +  34*)4  +  ft/(l+#x))(34  -  34*)(-4  +  4). 
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(13) 


hP.  =  (■<?  -  +  {-n  +  3^*)4  +  I'fj/d+^yiK-se  +  3{")(4  -  4)- 

The  strain  energy  can  be  calculated  from 

»'«  =  iio/‘(f/lr«  +  GAk,tl  +  GAk,y\  +  Sfi\  +  EI^  +  C/jt’jdf.  (14) 


Substituting  (10)  with  the  interpolations  (13)  m  the  integral  (14)  yields,  if 
only  terms  up  to  the  third  order  are  retained, 

tt"  -  wamA)^  +  i(5./iJ)(4)'  + 

i(£/,/(J)(4(4)’  -  4£;«1  +  4(4)*  -  I3lf./(l+#.)!(4  -  4)'>  + 

-  4£!4  +  4(4)’  -  (3V(i+!f,)i(4  -  4)’)  + 

(f4/(30lj)!£ill7(£l)’  +  £j£j  +  2(4)*  +  17(4)*  +  £^4  +  3(4)’!  + 

(s</i5)4(  -  - 1«14  +  i44  -  j«i4  )  + 

[(Wy  -  £'/,)/i;!£((£S4j  -  £(4  -  £|4  +  34i4)  (15) 

With  the  aid  of  the  inversion  of  (12),  the  original  barred  strains  t  can 
be  substituted  for  the  linearized  strams.  Then  stress-strain  relations  are 
obtained  by  taking  partial  derivatives  with  respect  to  the  strains.  These 
non-linear  relations  between  generalized  stresses  and  strains  could  be  used  in 
calculations,  but  we  prefer  to  redefine  the  generalized  strains  in  such  a  way 
that  the  third-order  terms  are  removed  from  the  expression  for  the  strain 
energy  and  the  linear  relation  between  generalized  stresses  and  strains 
remains  valid.  The  reason  for  this  transformation  is  that  it  gives  a  clear 
separation  of  physical  and  geometrical  non-linearities;  the  non-linearities  in 
the  present  formulation  clearly  stem  from  the  geometry.  Furthermore,  the 
treatment  of  mitial  deformations  remains  simple  and  constramts  such  as 
uiextensibility  can  be  specified  m  a  simpler  way.  It  can  be  checked  that  the 
required  modified  generalized  strains,  which  are  denoted  by  e,  are 

^1  •  ^1  (2^3  +  €354  +  2C4  +  2^5  +  C5C5  +  2c«)/(30/p), 

fj  -  Cj  +  (“CsCfl  + 

Cs  «  ff3  +  Cjlfj  +  Cfl)/(6(o)i 

£4  «  C4  -  ffjlCs  +  efl)/(6(o), 

Ca  *  fs  -  C2(cj  +  i4)/(61o), 

£*  »  Cs  +  ^2(^3  +  f4)/(61ci>-  (16) 

The  correspondmg  generalized  stresses  <r  have  now  a  slightly  modified  meaning 
m  the  case  of  finite  deformations 
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The  additional  tenns  in  take  into  accoimt  the  additional  elongation  of 
the  beam  axis  caused  by  its  bending  and  the  additional  tenns  in  €2  nieasure  the 
extra  torsion  of  the  beam  caused  by  its  bending.  If  the  flexural  rigidity  is 
equal  in  all  directions,  the  strains  to  need  not  be  modified  as  can  be 
seen  from  (15),  the  additional  terms  take  mio  ^count  the  effect  of  symmet¬ 
rical  bending  caused  by  a  twist  of  the  beam.  In  planar  problems,  £]•  ^4 

are  zero  and  only  C}  is  modified.  Because  the  rigidity  against  elongation  is 

much  larger  than  the  flexural  and  torsional  rigidity,  the  modification  of 
is  the  most  important  one  and  the  other  modifications  are  only  relevant  to 
more  special  cases,  for  instance  when  one  has  large  differences  m  flexural 

rigidities,  the  beam  is  used  as  a  shaft  for  the  transmission  of  a  torque,  or 

one  has  initial  deformations  in  precurved  and  pretwisted  beiwns. 

The  inertia  terms  are  calculated  in  the  same  way  as  in  (9).  The  inter¬ 
polation  for  the  elastic  Ime  for  finite  deformations  is  now  taken  to  be 

r(()  -  (1  -  +  ((  -  2f»  +  +  £,)ef  + 

(se  -  2{>)x'  +  {-e  +  {■•'(/,  +  £,)*; .  d?) 

In  many  cases  f|  is  small  and  can  be  neglected;  It  is  only  included  in  (17)  in 
order  to  obtain  the  classical  mass  matrix  for  small  longitudinal  vibrations. 
Even  if  longitudinal  vibrations  are  important,  better  approximations  of  the 
eigenfrequencies  are  obtained  if  this  tenn  is  neglected.  If  we  put  Si  equal  to 
zero,  and  the  mass  per  unit  of  length  is  m,  we  obtain  the  mass  matrix  and 
convective  inertial  terms  by  evaluating  the  integral 

(18) 

0 

If  the  rotations  of  the  nodes  are  parametrized  by  ^  and  this  results  in 
the  mass  matrix 

156  1  221, A  MI  -13loB 

ml,  4|Ja^A  13I,A^  -3/5a^ 

”  —  1561  -22/ oB  ■ 

symra.  4|Jb^ 


and  the  inertia  terms  which  are  quadratic  in  the  velocities 
/o(22AVP^P-l3BW’) 
ml,  ^(4A^AV'^'-3A^V*^») 
lo(13A’(?8^i’-22BV’^«) 
i;(-3B''A  V'V'+AB'B  VW 


B  *  A’  »  B’  *  dd/d<fii 
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The  rotary  meriia  of  the  cross-section  can  be  lumped  onto  the  nodes, 
half  of  the  total  rotary  mertia  of  the  beam  on  each  node. 

The  equations  of  motion  for  a  complete  system  are  formed  by  the  algorithm 
of  (8,9],  which  is  based  on  the  principle  of  virtual  power  and  uses  a  minimal 
set  of  differential  equations. 


3.  Application  to  Elastic  Stability  Problems 

In  order  to  check  whether  the  geometric  stiffness  is  represented  properly  in 
the  described  element,  two  spatial  tmear  bucklmg  problems  are  analysed  for 
which  analytical  solutions  are  known.  In  these  examples,  the  influence  of 
transverse  shear  is  not  considered. 

The  first  example  is  the  lateral  buckling,  or  tipping,  of  a  clamped-free 
beam  with  a  narrow  rectangular  cross-section  which  is  loaded  by  a  transverse 
force  at  its  end  in  the  direction  of  the  larger  flexural  rigidity.  The 
theoretical  buckling  load  is  »  4  where  El  is  the  smaller 

flexural  rigidity  and  /  is  the  length  of  the  l^am.  For  the  numerical  analysis, 
the  beam  is  divided  in  one,  two  or  four  equal  elements  and  the  two  cases  in 
which  the  second  order  terms  in  the  generalized  strains  are  retamed  or  not 
are  considered.  The  results  are  given  in  Table  1,  where  fJ,.  are  the  critical 
loads  which  are  obtained  without  the  second-order  terms  and  are  the 
critical  loads  when  these  terms  are  mcluded  in  the  analysis. 


Table  1.  Critical  loads  for  lateral  buckling  by  a  force. 


number  of 
elements 

FlrlFtH 

1 

infinite 

1,4951 

2 

1.2180 

1.0690 

4 

1.0459 

1.0153 

We  observe  that  with  the  incIu*ion  of  the  second-order  terms  m  the 
bending  deformations,  the  error  in  the  buckling  load  is  decreased  by  a  factor 
of  about  three,  while  the  order  of  convergence  remams  two.  Both  approxima¬ 
tions  converge  to  the  theoretical  value. 


Table  2.  Ciitical  loads  for  bucklmg  by  a  torsion  moment. 


number  of 
elements 

Mcr/W.» 

1 

infinite 

1.1027 

2 

1.2732 

1.0075 

4 

1.0548 

1  0005 
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Hie  second  example  is  the  buckling  of  a  clamped-free  circular  shaft  by  a 
torsion  moment  at  its  free  end  If  the  torsion  moment  is  semitangential.  the 
theoretical  buckling  load  is  Mth  »  nEI/t  [13].  Table  2  shows  the  results  of 
the  calculations,  where  the  symbols  have  a  similar  meaning  as  m  Table  1.  We 
observe  that  the  mclusion  of  second-order  terms  raises  the  order  of  conver¬ 
gence  from  two  to  four  in  this  case. 

With  the  mclusion  of  the  second-order  terms  m  the  strams,  we  obtain, 
apart  from  numerical  errors,  the  same  answers  as  Argyris  et  al.  {14j.  This  is 
also  the  case  m  the  other  examples  of  [14],  which  are  not  reported  on  here. 

The  order  of  convergence  in  the  lateral  bucklmg  problem  remams  two. 
because  the  bucklmg  mode  mvoWes  torsion,  which  is  approximated  by  a  Imear- 
ly  varymg  torsion  angle  If  a  polynomial  approximation  of  the  third  degree  is 
used,  a  higher  order  cf  convergence  can  be  obtamed  (IS). 


4.  Slider-Crank  Mechanism  with  a  Flexible  Connecting  Rod 


-4*  elements 
•  2  elements 


J  0000 


cranx  angle  (rad) 

Figure  1.  Dimensionless  deflection  of  the  centre  poml  of  the  connecting  rod 
of  a  shder-crank  mechanism,  u  «  124.8  rad/s,  »  0. 


The  transient  response  of  a  slider-crank  ir*chanism  with  a  rigid  crank  and  a 
flexible  connectmg  rod  has  been  the  subject  of  a  considerable  number  of 
studies  Chu  and  Pan  (16)  treated  among  other  oases  the  example  m  which  the 
crank  has  a  length  of  0.1524  m,  the  connectmg  rod  has  a  length  of  0.30-18  m 
and  a  circular  cross-section  v^iih  a  diameter  of  0.00635  m  and  the  slider  block 
is  massless  The  material  of  the  connectmg  rod  is  steel  with  a  density  of  p  = 
7834  56  kg/m’,  a  Young’s  modulus  E  »  2  06843.10”  N/m’,  a  Poisson’s  ratio  v  = 
0  235  and  no  material  dampmg  The  constant  rotation  speed  of  the  crank  is  w'  = 
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124.8  rad/s  The  motion  is  simulated  over  a  rotation  angle  oi  the  crank  of  8 
rad,  starting  from  the  mitial  conditions  that  the  defonration  and  deformation 
rate  of  the  connecting  rod  are  zero.  The  measured  output  quantity  is  the 

lateral  deflection  of  the  centre  point  of  the  connectmg  rod  divided  by  its 
length. 

As  a  reference  we  modelled  the  connecting  rod  with  four  planar  beam 
elements,  with  all  effects  included  (12  degrees  of  freedom).  The  results  are 

given  as  the  solid  line  in  Fig.  1.  If  the  connectmg  rod  is  modelled  by  two 
beam  elements  and  the  normal  and  shear  deformation  as  well  os  the  rotary 
inertia  are  neglected  (4  degrees  of  freedom),  the  results  given  by  the  dashed 
line  are  obtained.  As  the  system  has  no  damping,  any  small  change  in  modelling 
or  numerical  mtegration  method  will  give  large  differences  of  solutions  at 

large  times.  Therefore  a  good  measure  for  the  comparison  of  results  seems  to 
be  the  value  of  the  first  maximum  of  the  deflection.  These  values  are  listed 

m  Table  3  and  are  compared  with  some  results  from  the  literature 


Table  3.  Comparison  of  the  results  of  different  calculations  of  the 
deflections  of  the  connectmg  rod  of  a  slider-crank  mechanism 


reference 

number  of 
elements  or  modes 

value  of  the 
first  maximum 

present 

4  e I ement » 

0.00976 

present 

2  e 1 ement  s 

0.00973 

IIS] 

1  mode 

0.0105 

(17) 

3  elements 

0.0094 

(18) 

2  elements 

0.0102 

(19) 

3  elements 

0.0098 

(20) 

2  elements 

0.0097 

We  remark  that  the  results  of  (16)  seem  to  overestimate  the  first  maximum 
and  the  geometric  non-linearity  was  not  accounted  for  m  (18),  {19}  and  (20) 
give  results  quite  sunilar  to  those  in  Fig.  1. 

As  the  rotation  speed  m  this  example  is  rather  low  and  the  mfluence  of 
the  couplmg  of  the  gross  motion  and  the  deformation  is  small,  the  same 
mechanism  is  studied  in  the  case  UiaI  the  rotation  speed  of  the  crank  is  150 
rad/s  and  the  mass  of  the  slider  block  is  ^ual  to  half  the  mass  of  the 
connectmg  rod.  The  results  of  simulations  with  two  and  four  elwnents  are 
shown  m  Fig.  2.  The  values  of  the  first  maximum  are  now  0.01394  (four 
elements)  and  0.01391  (two  elements).  Results  from  studies  in  which  the 
geometric  non-lmearily  is  not  mcluded  (21,  22,  23)  overestimate  this  value, 
on  the  other  hand,  a  study  m  which  this  effect  is  mcluded  (24),  underesti¬ 
mates  the  maximum. 
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Figure  2.  Duncasionless  deflecuon  of  the  centre  point  of  the  connecting  rod 
of  a  slider-crank  mechanism.  0  m  150  rad/s,  »  0.0378126  kg. 


b.  SpIn-up  Motion  of  «  Beam 

5.1.  PLANAR  SYSn^i  •; 

The  next  example  system  consists  of  a  beam  whose  base  is  attached  to  a  shaft 
orthogonal  to  the  ^am  axis,  which  is  given  a  prescribed  rotation.  In  particu¬ 
lar  the  $pin-up  motion  is  considered,  in  which  the  beam  is  accelerated  from 

rest  to  a  constant  angular  velocity.  The  prescribed  angle  of  rotation  v  is  ; 

given  by 

^  -4  0  s  t  £  r,  ; 

r  4Jr*  r 

V .  -  jr),  t  >  r.  (22)  j  * 

Firstly  we  take  the  case  from  (25,  26),  m  whicn  the  length  of  the  beam  ! 

is  i  a  8  ra,  the  beam  has  a  rectangular  cross-section  of  0  03676  m  by  0.001986  \  i 

m  and  is  made  of  jUuminium  with  p  «  2766  67  kg/m\  £*  «  6  895.10*®  N/m*.  and  y  \  t 

»  0.32  The  final  angular  velocity  is  w*  «»  4  rad/s,  and  the  spin-up  tune  is  T*  j  . 

»  15  s  The  beam  is  modelled  by  four  and  two  elements,  as  before,  and  the  j  » 

lateral  deflection  of  the  tip  of  the  beam  is  taken  as  an  observed  quamuy,  ^ 

for  which  results  are  given  m  Fig.  3  The  extreme  value  of  the  deflection  is  ^ 

-0  5360  m  (four  elements)  and  -05338  m  (two  elements)  i 


I  I 

i 


Figure  3.  Later&l  deflection  for  the  spin-up  motion  of  [25,  26). 


The  extreme  v&iue  m  (25,  26)  is  -0.M3  m  in  their  most  accurate  model; 
the  general  shape  and  the  residual  vibrati^  for  t  >  15  s  agree  vith  our 
results.  Apparently,  the  results  given  In  (27)  contain  large  errors. 
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Secondly,  we  lake  the  case  of  (28),  with  £.  »  10  m,  p/1  *  1 2  kg/m,  El  » 

14000  W,  pi  «  0.0006  kgm,  GAk  »  1 10^  N,  EA  *  2.8.10^  N,  and  w*  =  6  rad/s, 

7**  15  s  The  results  for  this  case  shown  m  Fig.  4.  The  extreme  values 

of  the  deflection  are  now  -05739  m  (four  elements)  and  -0  5726  m  (two 

elements);  the  amplitude  of  the  vibrations  for  t  >  15  s  is  0.0037  m.  If  we 
compare  these  results  with  those  from  the  literature,  we  observe  that  the 

extreme  deflection  is  about  1%  lower  m  |28},  about  l5t  higher  m  (29}  and 
about  2%  higher  in  (30).  The  amplitude  of  the  residual  vibrations  in  (29,  30) 
IS  higher. 

In  general  we  may  conclude  that  several  calculations  give  comparable 
results  for  this  problem.  With  Uie  beam  element  presented  in  this  paper  we 
were  able  to  obtain  an  error  of  less  Uian  196  with  a  model  with  two  elements 
having  four  degrees  of  freedom,  while  others  needed  more  elaborate  models  to 
obtain  the  rme  accuracy. 

5.2.  SPATIAL  SVSTFM 

In  (1),  the  spin-up  motion  was  considered  for  the  case  m  which  part  of  the 
beam  had  an  open  channel  aoss-scction.  The  beam  element  we  have  described 
here  is  not  intended  to  solve  probl^ns  involving  beams  with  an  open  thm- 
walled  cross-section.  The  torsional  stiffness  is  very  low,  which  causes  that 
effects  which  may  safely  be  neglected  for  beams  mth  a  solid  cross-section  can 
be  important,  such  as  the  consttaint  of  warping  a*  the  ends,  the  eccentricity 
of  the  centre  of  shear,  the  shortening  of  beam  due  to  torsion,  and  the  distor¬ 
tion  of  the  shape  of  the  aoss-section.  Furthermore,  local  phenomena  and  the 
distribution  of  residual  stresses  may  become  impotiant.  It  is  advisable  to 
develop  special  elements  for  probl^ns  involvmg  beams  of  this  nat.re,  or  to 
use  plate  and  shell  elements. 

Some  aspects  of  thin-walled  open  cross-section  beams  can  be  mcluded 
approxunately  into  the  analysis  with  the  present  element.  The  effect  of  the 
constrained  warping  can  be  approximated  by  introducing  an  effective  torsional 
stiffness  which  gives  the  same  relative  rotation  angle  of  the  end  nodes  if  the 
beam  is  loaded  by  a  torque.  This  »  a  good  approximation  if  the  influence  of 
the  warping  constraint  is  confined  within  zones  near  the  ends  of  the  beam,  m 
which  case  one  may  introduce  the  effective  length  of  the  beam,  Lf  »  L  - 

(fT/S,)*/*,  where  P  is  the  warping  constant. 

The  effect  of  the  eccentricity  of  the  shear  centre  can  be  accommodated 
for  by  modelling  the  beam  with  two  parallel  elements,  one  along  the  Ime  of 

centroids,  and  one  along  the  line  of  shear  centres,  whose  ends  are  rigidly 
eccentrically  connected.  The  mass  and  normal  stiffn^  are  attributed  to  the 
centroid  element,  and  the  torsional  and  flexural  rigidity  are  attributed  to 

the  shear  centre  element. 

The  beam  considered  in  (1)  has  a  l^gth  of  16  m  and  is  buut  up  from  a 
rigid  beam  of  length  8  m,  a  doubly  syimnetric  tube  of  length  2|  m.  and  a 
channel  of  length  SJ  m.  The  material  is  aluminium  with  p  ■  2766.67  kg/m*,  E  -« 
6  895.10*®  N/m*,  and  G  »  2  6519.10*®  N/m*.  The  properties  of  the  tube  are  A  * 
0  000384  m*,  /  ■  1.5.10’*  m*,  and  S*  «  5834.18  Nm*,  and  those  of  the  channel 
are  A  «  7.3.10'*  m^  /y  -  4  8:46.10'®  m*,  /,  «  8.2181.10'®  m*,  S,  «  0  645207 
Nm*,  P  B  5.0156.10'**  m®,  and  the  eccentricity  of  the  shear  centre  is  Zq  « 
-0.01875  m.  Initially  the  beam  is  located  along  the  global  X-axis.  while  the 
shaft  IS  in  the  direction  of  the  global  Z-axis.  In  the  modelling  of  this 


example,  one  beam  element  is  used  ^or  the  tube  and  four  equal  pairs  of  beam 
elements  for  the  channel.  Effects  of  shear  deformation  and  normal  force 
deformation  are  not  included.  The  spin-up  time  is  7**  »  15  s,  and  the  final 
angular  velocity  w*  «  6  rad/s. 
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Figure  5  shows  the  deflection  of  the  centroid  of  the  tip  in  the  two 
directions  perpendicular  to  the  undeformed  axis  of  the  beam.  Figure  6  shows 
the  total  torsion  angle  of  the  beam.  The  most  conspicuous  difference  from  the 
results  of  (1)  is  that  u.  has  the  opposite  sign  and  returns  to  zero  when  the 
beam  rotates  at  a  constant  angular  velocity.  This  difference  is  due  to  the 
fact  that  the  theory  in  {!)  is  based  on  the  assumption  of  small  deflections 
and  an  error  in  the  expression  for  the  strain  energy  Furthermore,  the  deflec¬ 
tions  shown  here  are  larger  than  those  in  [I],  This  is  also  caused  by  a  sof- 
tcnmg  effect  in  the  torsional  rigidity  for  large  torsion  angles  in  our 
present  element. 


coiv'ludlng  Remarks 

lu*'  pr«rsent  paper  has  pointed  out  the  imponemce  of  the  inclusion  of  the 
geom>:tnc  non-lmearity  in  the  modelling  cf  beams  and  the  validation  of 
results  obtained  with  these  elements.  The  examples  treated  here,  however,  can 
only  be  considered  as  a  commencement  of  the  process  of  validation,  especially 
as  few  spatial  examples  were  considered.  Therefore,  a  further  study  seems 
appropriate. 

For  slender  beams,  the  effects  of  transverse  shear  deformation  and 
elongation  of  the  beam  axis  appear  to  be  small.  The  rotary  inertia  of  the 
aoss-section  is  only  important  if  torsional  vibrations  can  occur. 

From  the  relative  ease  with  which  it  was  possible  to  include  second-order 
terms  in  the  description  of  the  stiffness  of  the  beam  element,  one  might 
expect  that  an  extension  to  higher  orders  of  approximation  is  straightforward. 
However,  a  consistent  inclusion  of  all  terms  is  involved  and  even  seems  to  he 
unnecessary  for  dynamical  problems,  because  some  minimal  number  of  degrees  of 
freedom  have  to  be  retained. 
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ABSTRACT.  A  method  for  modeliag  pUsw  aad  tpAttal  mechamems  is  presented  which  is 
ctpsble  of  efficiently  predicting  the  nonUnenr  ttnntient  response  of  fiexible  systems  Large  defer* 
mations  are  assumed  and  nonlinear  geometric  properties  are  eneorporated.  In  this  research,  each 
element  of  a  mechanum  is  treated  as  an  individual  body,  with  its  own  flexible  and  rigid  body  modes. 
Constrainu  are  used  to  enforce  compatibility  conditions  between  the  individual  hdits  which  make 
up  a  mechanism.  One  of  the  unique  features  of  this  study  is  how  the  constraint  equations  are  han* 
died.  They  are  initially  introduced  into  the  global  system  of  equations  using  Lagrange  multipliers. 
The  classical  solution  technique  is  to  numencally  solve  for  the  Lagrange  multipliers  and  the  gener* 
alited  coordinates  together.  In  thu  study  the  Lagrange  multipliers  are  first  analytically  eliminated 
from  the  equations  of  motion.  As  a  result  the  constraint  equations  are  eneorporated  directly  into 
the  system  of  ordinary  difTerential  equations  of  motion,  without  the  need  to  solve  for  the  Largange 
multipliers. 

1  Introduction 

Most  of  the  work  in  mechanism  deformation  analysis  is  based  on  the  linear  theory  of  elas* 
tluty  In  most  of  these,  a  kinematics  and  ngid  body  analysis  is  used  to  solve  for  the 
gross  body  motion  and  the  inertial  forces.  By  employing  different  techniques,  the  elastic 
deformations  are  then  found  by  applying  these  inertial  forces  as  externally  appbed  forces 
to  the  linear  elasticity  problem.  The  small  elastic  deformations  are  superimposed  onto  the 
gross  motion  in  order  to  predict  the  total  motion  of  each  link  in  the  system. 

Recently,  several  researchers  have  presented  methods  which  couple  the  gross  body  motion 
and  the  elastic  deformations  (4-9).  In  these  methods  the  configuration  of  each  elastic  body 
is  identified  using  two  sets  of  coordinates.  These  generalized  sets  of  coordinates  denne 
the  location  and  orientation  of  a  reference  frame,  with  respect  to  an  inertial  frame,  and  the 
elastic  coordinates  that  describe  the  deformation,  defined  with  respect  to  the  body  reference. 
The  equations  of  motion  for  the  mechanism  are  then  expressed  in  terms  of  these  two  sets 
of  coordinates.  Depending  on  the  required  type  of  motion,  operating  speed  and  restrictions 
on  the  design,  some  mechanisms  will  exhibit  large  deformations.  These  large  deformations 
necessitate  a  nonlinear  dynamic  deformation  and  stress  analysis.  Some  research  based  on 
nonUnear  analysis  can  be  found  in  references  (6-12). 

The  purpose  of  this  study  is  to  develop  modeling  and  solution  techmques,  and  subse¬ 
quently,  a  computer  p''ogram  capabU  of  efiiaeatly  analyzing  the  nonlinear  transient  re¬ 
sponse  of  planar  and  spatial  mechanisms.  In  this  research,  each  element  of  a  mechamsm 
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is  treated  as  an  individual  body,  with  its  own  flexible  and  rigid  body  inodes.  Constraint 
equations  are  then  used  to  enforce  the  necessary  compatibility  conditions  between  the  indi¬ 
vidual  bodies  wtuch  mahe  up  the  mechazusm.  By  doing  this,  a  mechamsm  can  be  modeled 
as  a  multibody  dynamic  system. 

Many  methods  have  been  used  to  represent  the  holonomic  and  nonholonomic  constraints 
of  ri^d  (13-16)  and  flexible  (17,18)  multibody  systems.  The  classical  approach  for  han¬ 
dling  constraints,  using  Lagrange  muittpUers,  has  the  drawback  of  increasing  the  number 
of  unknowns  by  the  number  of  constraints.  Other  methods  for  handling  constraints  include 
the  use  of;  a  penalty  formulation  (19),  orthogonal  compliment  arrays  [20],  recursive  formu¬ 
lations  (21),  and  component  mode  synthesis  (22).  Most  of  the  recent  work  in  constrained 
multibody  dynamics  use  the  classical  Lagrange  multiplier  approach  either  in  conjunction 
with  other  approaches,  such  using  bond  graphs  (23),  or  various  mathematical  operations,  to 
reduce  the  number  of  degrees  of  freedom  and/or  increase  the  stability  of  the  problem  (24). 
One  of  the  unique  features  of  this  study  is  how  the  constraint  equations  are  handled.  In 
this  study  the  constraints  are  introduced  into  the  system  of  equations  using  Lagrange  mul¬ 
tipliers.  The  Lagrange  multipliers  are  then  solved  for  directly  and  substituted  back  into 
the  system  of  equations.  The  result  is  a  ^obal  system  of  equations  which  encorporates  the 
constraints  without  increasing  the  degrees  of  freedom  of  the  system. 

2  Generalized  Beam  Element  Kinematics 

The  displacements,  velodties  and  accelerations  of  a  general  flexible  beam  element  which  is 
part  of  a  mechanism,  undergoing  ri^d-body  and  flexible  deformations,  is  presented  in  this 
section  with  respect  to  a  fixed  global  coordinate  system,  G. 

The  ri^d  body  orientation  of  a  beam  element  is  desaibed  by  a  rigid  body  translation 
and  a  sequence  of  rotations.  The  local  coordinate  systems,  H  and  B,  of  the  beam  element 
are  attached  to  the  endpoint  of  that  element.  Coordinate  system  H  differs  from  the  inertial 
coodlnate  system,  G,  by  a  translation  of  { Xo  Yg  Zq  )  wd  coordinate  system  E  is 
deflned  to  have  the  same  ori^n  as  H  with  its  t-axis,  kgs*  colisear  with  the  dutic  axis 
of  the  beam  element.  The  position  vector,  relative  to  local  coordinate  system,  E,  of  any 
material  point  P,  on  an  elastic  beam  element  can  be  descibed  as, 

rpD  =  (*p  +  «) 

=  (xS  +  U^)iB  +  xJio  (1) 

where,  0  0  ]  is  the  distance  along  the  elastic  axis,  ~  [  0  Sp  ]  is  the  position 

in  the  cross  section  of  the  beam,  s  ( v  w]  are  the  elastic  deformations  at  Xp,  and 
io  is  the  deformed  element’s  coordinate  system,  relative  to  E.  The  position  vector  of  this 
point,  at  any  time,  relatve  to  the  inertial  coordinate  system,  G,  Is  illustrated  in  Figure  1, 
and  can  be  expressed  as, 

R/'D  =  +  rpz>  (2) 

where, 

=  (Xc)erC  +  (yG)ev<J  +  (^<?)*»c  =  (^c)«c  (3) 
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Figure  1:  Position  Vector  of  Point  Pp  on  the  Deformed  Element. 


Equation  (2)  is  deftned  in  terms  of  the  inertial,  local  and  deformed  systems  of  coordinates, 
G,  E,  and  D  respectively.  Transformation  matrices  are  needed  to  express  this  equation 
strictly  in  terms  of  the  global  coordinate  system  The  rigid*body  transformation  matrix  is, 


Toe  « 


C,C,  CyS,  -$y 

StSyO$  •  SfSySt  +  OgCt  SfCy 

OgSyCt  +  SgSf  OfSySt  ”  SgOt  OgOy 


(4) 


By  using  a  second  order  therory  of  elasticity  the  transfo*mation  between  the  undeformed 
and  deformed  coordinate  systems  can  be  denned  as, 


Ted  = 


1 

-  {w^0  +  Vj)  I  9 

-  -  V^0)  -  (^  +  V,tW,g)  I 


(5) 


The  transformations  of  the  coordinate  systems  are  then  defined  by,  ko  =  Toe^h  and, 
e<;  =  TceTed^D'  By  substituting  these  relations  into  Equation  (2),  Kpd  becomes, 

Rpo  =  (Xc  +  (jc// -f  Tc£:U)  +  TcET^i>(xp)  ]  ec  (6) 


Rpo  now  represents  the  position  vector  of  a  general  point,  Poy  on  the  element,  in  terms 
of  the  fixed  system  of  coordinates  G.  A  complete  derivation  of  this  can  be  found  in  refer* 
ence  (25). 

The  elastic  deformations  of  the  beam  element  are  obtained  using  a  Finite  Element 
Method  First  order  polynomials  are  chosen  for  the  shape  functions  of  the  axial  displace* 
ment,  n,  and  the  twist  about  the  x/r-axis.  9,  of  the  element  These  values  are  expected  to 
be  relatively  small  when  compared  to  the  the  v  and  w  directions.  The  transverse  defor* 
mations.  v  and  w,  are  described  using  fifth  degree  Hermite  polynomials  m  order  to  ensure 
continuous  curvature  between  elements  [l.lOj 
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3  Elemental  Equations  of  Motion 

in  this  study  a  variable  correlation  table  and  a  set  of  constraint  equations  are  used  to  as¬ 
semble  the  elemental  equations  into  the  ^obal  system  of  equations  of  motion  for  a  comp.c' 
flexible  multibody  system.  The  variable  correlation  table  is  used  to  identify  the  n^d  bway 
and  flexible  degrees  of  freedom  of  the  mechanism  and  the  constraint  equations  relate  the 
degrees  of  freedom  of  one  element  to  the  degrees  of  freedom  of  another  element.  These 
constraints  are  introduced  into  the  system  of  equations  using  Lagrange  multipliers.  The 
Lagrange  multipliers  are  then  solved  for  directly  and  substituted  back  into  the  system  of 
equations.  This  practice  and  the  use  of  a  variable  correlation  table  avoids  increasing  the  de¬ 
grees  of  freedom  of  the  system  and  allows  for  a  wide  variety  of  methodologies»  ranging  from 
the  classical  Finite  Element  approach  to  a  complete  flexible  multibody  dynamics  analyiii, 
where  each  element  is  consider^  to  be  a  separate  entity. 

Lagrange’s  equation  is  applied  to  a  general  flexible  beam  element  in  the  following  section. 
This  includes  the  Idnetic  energy,  strun  energy  and  externally  applied  forces.  The  variable 
correlation  table  and  the  constraint  functions  are  then  presented,  followed  by  the  global 
system  of  equations  of  motion  for  a  general  multibody  system.  This  system  of  equations 
maintains  a  complete  coupling  between  the  n^d  body  and  flexible  modes,  and  is  used  to 
solve  for  the  ri^d  body  motion  and  flexible  deformations  simultaneously. 

3.1  LAGRANGE’S  EQUATIONS 

The  matrix  differential  equations  of  motion  for  a  single  finite  element  of  a  mechanism 
is  developed  by  employing  Lagrange’s  equations.  This  system  of  elemental  equations  of 
motions  can  then  be  assembled  into  a  globJi  set  of  equations  for  the  entire  mechanism. 
The  Lagrange’s  equations  for  an  element  can  be  represented  as, 


where,  the  vector  contains  the  complete  set  of  generalized  coordinates  for  the  general 
beam  element,  and  C  is  the  Lagran^ao  of  the  element,  which  is  defined  as, 

C  ^  KE  -  SE  -  F,  (8) 

where,  KE^  SE  and  F,  are  the  kinetic  energy,  strain  energy  and  externally  applied  forces 
of  an  element,  respectively.  By  extracting  the  generalized  veloaties,  the  kinetic  energy  can 
be  expressed  as, 

KB  =  (9) 

where  the  generalized  velocities,  Q,,  are  defined  by, 
iT  r  uT  1.T  .Tl 

Q.  =[X<;  $G  q.  j 

where,  Xq  are  the  rigid  body  displacments,  $g  are  the  rigid  body  rotations, 
the  flexible  deformations.  Similarly  the  strain  energy  can  be  expressed  as, 

SB  =  iQ’’K,q 


(10) 
and  qf  are 

(11) 
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The  modeling  of  the  gra.vitational  force  is  straight  forward  and  is  characterized  by  a  gravi* 
tationai  vector.  By  defining  G  =  where  g  is  the  gravitational  constant  and  is  the 
unit  vector  that  defines  the  direction  of  action  of  the  gravitational  force,  the  force  on  an 
element  is, 

F,  =  RjCoG  (12) 


By  perfomung  the  partials  and  time  derivatives  on  the  kinetic  energy  m  the  Lagrangian 
the  following  is  obtained, 


mA,  +  cA, 


(13) 


where  the  mass  matrix,  Me,  is  defined  by  Equation  (9)  and  the  velocity  matrix,  contains 
the  centrifugal  and  correoUs  terms. 

By  performing  the  partial  of  the  strain  energy  terms  and  the  gravitational  force,  of  the 
Lagrangian,  the  equations  of  motion  for  a  single  flexible  element  can  be  written  in  the 
following  form: 


+  CA,  +  KAe  =  Fe 


(14) 


where,  M(,  C«  and  K«  Is  defined  by  Equations  (9),  (13)  and  (11),  respectively 
Equation  (14)  is  the  the  differentia  equations  of  motion  for  a  single  flexible  beam  element. 
The  equations  of  motion  for  the  entire  system  are  obtained  by  assembling  the  elemental 
matrices  into  a  global  system  of  equations.  This  is  done  through  the  use  of  a  variable 
correlation  table  and  constraint  functions.  These  are  discussed  in  the  following  sections 
and  then  the  global  system  of  equations  are  presented. 


3.2  VARUBLE  CORRELATION  TABLE 

The  elemental  matrices  developed  in  the  previous  section  must  be  assembled  to  form  the 
governing  differential  equations  of  motion  which  describe  the  vibration  of  the  entire  mech¬ 
anism.  The  variable  correlation  table  is  used  to  assemble  each  element’s  matrices  into  the 
global  matrices. 

From  Equation  (14),  the  vector  Q«  represents  the  independent  local  coordinates  of  an 
element  jvhlch  is  part  of  a  mechanism.  The  variable  correlation  table  maps  the  displace¬ 
ments,  Q’,,  of  the  element  t  into  the  global  displacements  Q,  of  an  entire  mechanism.  The 
result  is  that  the  general  elemental  matrices  Me,  Cr  and  K,,  and  the  forcing  vector,  F«, 
for  each  element  are  assembled  into  the  global  vibrational  system, 

+  KQ  =  f  (15) 

Assembling  M,  C,  K  and  F  in  this  manner  permits  the  creation  of  a  general  algorithm 
for  forming  the  equations  of  motion  for  a  general  multibody  system.  This  algonthm  is 
appbed  to  each  element  in  turn,  until  the  equations  of  motion  for  the  entire  mechamsm 
have  been  created. 
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3  3  CONSTRAINT  FUNCTIONS 


In  this  study  ench  element  is  considered  to  have  both  rigid  body  displacement  and  flexible 
deformations.  Because  of  this«  maintaining  the  compatibility  between  elements  it  not  as 
straight  forward  as  in  a  classical  Finite  Element  approach.  The  variable  correlation  table 
can  be  used  to  relate  one  elemental  degree  of  freedom  to  one  global  degree  of  freedom  in 
a  classical  finite  element  fashion.  This  method  is  sufficient  for  relating  single  degrees  of 
freedoms  of  elements  to  each  other*  but,  in  general  it  is  not  sufficient  for  relating  multiply 
degrees  of  freedom.  In  order  to  handle  these  situations  constraints  will  be  used.  Each 
constrsint,  <(,  is  represented  by  an  equation  of  the  form, 

*  =  0  (16) 

Position,  slope  and  curvature  are  the  three  general  types  of  constraints  which  are  m* 
corporated  in  this  study  in  order  to  ensu.e  the  compatibility  between  elements  and  define 
the  configuration  of  the  mechanism,  which  van  not  be  handled  using  the  variable  correla* 
tioo  table.  The  specifics  of  each  of  the  position  constraints  are  discussed  in  the  following 
subsection. 

S.S.t  Position  Constraints.  Position  constraints  are  used  to  fix  the  position  of  an  ele> 
ment’s  node  relative  to  either  time,  the  ground  or  the  node  of  another  element.  Five  specific 
position  constraints  are  employed  in  this  study.  The  first  constraint  is  a  driving  constraint 
which  is  used  to  fix  a  global  degree  of  freedom,  relative  to  time.  The  second  time 
derivative,  (i.e.  acceleration),  is  the  form  employed  in  this  research  in  order  to  fix  a  degree 
of  freedom  as  a  function  of  time.  Specifically, 

♦  =  q*  -  ^ace(l)  a  0  (17) 

where,  ^occ(()  Is  a  user  defined  prescribed  function  which  is  assumed  to  have  the  form: 

qacc{t)  s  4>  ajt  +  +  04sin(ast)  +  oeC08(art)  -f  o|exp(o«()  (18) 

The  selection  of  the  the  initial  position  and  velocity,  Qo  and  Qo  respectively,  and  the 
constants  o,,  dictate  the  exact  motion  of  a  single  degree  of  freedom  as  a  function  of  time. 
This  equation  is  by  no  means  unique,  and  was  defined  so  that  a  wide  variety  of  motions  are 
available.  U  wu  defined  for  this  etudy  to  offer  the  properties  of  polynomial,  trigonometnc, 
and  exponential  terms.  The  main  purpose  for  tUs  constraint  is  to  define  the  driving  function 
of  a  crank  link,  but  it  can  be  applied  to  any  degree  of  freedom  whose  position,  as  a  function 
of  time,  can  be  defined  by  an  expression  of  the  form  of  Equation  (18). 

If  a  constant  velocity  is  desired  then  all  of  the  constants  in  Equation  (18)  are  set  to  zero. 
This  equation  can  also  be  used  to  dictate  a  start-up  maneuver  in  order  to  achieve  a  desired 
operating  speed.  For  example,  if  a  mechanism  is  startmg  at  rest  and  is  to  run  at  a  constant 
operating  speed  of  and  it  is  desired  that  this  speed  be  reached  in  1  second,  then  the 
constants,  ui,  •  •  •  ,04,  can  be  chosen  so  that  qaee  function  is, 

(19) 

This  IS  just  one  spin^up  maneuver  which  can  be  used  to  start  a  mechanism  from  rest  and 
bring  the  operating  speed  up  to  a  desired  constant  velocity.  By  choosing  different  values  for 
ai ,  •  •  • ,  09  a  wide  variety  of  acceleratioo  profiles  can  be  defined  to  achieve  a  desired  motion. 


The  second  type  of  position  constramt  is  a  ground  constraint.  This  constraint  is  used  to 
fix  the  position  of  an  element’s  node  in  global  space.  The  ground  constraint,  which  is  used 
m  this  study,  which  relates  the  position  of  an  elements  node.  Rpdi  to  the  hxed  point,  X/, 

IS  given  as. 

4  =  RpD  -  X/  =  0  (20) 

Another  type  of  constraint  which  relates  an  element’s  node  to  the  ground  is  a  sbding 
constraint.  TUs  conatraunc  is  used  to  restrict  a  node  of  an  elejnent  to^move  along  a  shdtng 
line  which  is  defined  by  two  points  in  the  global  workspace,  and  X2.  This  can  be  done 
by  conitraimng  the  coordinate  directions  of  the  node,  similar  to  Equation  (20),  and/or  by 
using  parametnc  equations  to  relate  tbe  coordinate  directions  to  each  other.  ^ 

If  there  is  a  ^ob^  coordinate  direction,  1,  such  that,  Xt(0  =  X}(i),  then  Kpo  must  lie 
in  a  plane  normal  to  coordinate  direction  t,  and  therefore,  Kpoi*)  can  be  grounded  in  that 
direction  by  equating  it  to  the  value  If  there  are  two  coordinate  directions  which 

meet  this  criteria,  (i.e.  Xt(t)  =  X3(t)  and  X|(;)  -  X2(;)).  then  Kpd  can  be  sufficiently 
constrained  to  a  sliding  Une.  If  it  is  the  first  node  of  an  element  that  is  sliding,  the 
constraining  of  a  coordinate  direction  can  be  accomplished  by  eliminating  the  appropriate 
degreefs)  of  freedom  from  the  variable  correlation  table  and  thus  a  constraint  of  this  type 
would  not  be  neo;issary.  U  a  coordinate  direction,  t,  of  Rpd  is  to  be  constrained  then,  the 
component  cf  Equation  (20)  can  be  used,  such  that, 

*  =  Rcd(0  -  X,(.)  =  0  (21)' 

For  the  case  of  a  general  sliding  constraint,  when  the  variable  correlation  table  and 
Equation  (21)  can  not  sufficiently  satisfy  tbe  sliding  constraint,  a  set  of  parametric  equations 
can  be  dehaed  using  the  points  which  define  tbe  sliding  Une,  ^1  and  :^2>  These  parametnc 
equations  relate  one  coordinate  direction  to  another  coordinate  direction,  and  at  most  2 
equations  are  required^ to  fuUy  charactenze  tbe  sliding  Une.  The  constants  of  a  resulting 
parametnc  equation,  P  and  can  be  used  define  a  sUding  constraint,  such  that, 

♦  =  P^KpD  -  Po  =  0  (22) 

If  Equation  (21)  can  be  appUed  to  two  coordinate  directions,  then,  Kpo  is  sufficiently 
constrained  to  be  ^ong  the  s/Wnpbne,  and  thus  Equation  (22)  1$  not  needed.  Otherwise,  if 
Equation  (21)  can  only  be  appUed  once,  Rpd  has  only  been  restricted  to  tbe  plane  coulaui’ 
ing  the  sUding  axis,  and  must  be  further  restricted  by  relating  tbe  remaining  coordinate 
directions  by  using  Equation  (22).  For  tbe  general  case  when  Equation  (21)  can  not  be 
appUed  to  any  of  the  coordinate  directions.  Equation  (21)  must  be  employed  twice  m  order 
to  sufficiently  constrain  an  elements  node  to  the  sUding  Une, 

The  previous  position  constraints  relate  an  element’s  nodal  position  to  time  or  the  global 
worl::pace.  A  constraint  equation  which  constrains  the  position  of  a  node  of  one  element 
to  be  equal  to  the  position  of  a  node  of  another  element,  as  illustrated  in  Figure  2,  is  given 
as, 

I  =  R*p'd  +  ToeT„3  -  R5?o  =  0  (23) 

where,  and  R^£)  are  the  position  vectors  of  the  elemental  nodes  cf  interest,  Tqe  is 
the  transformation  matrix  between  the  global  and  elemental  coordinate  systems,  Td  is  tbe 


Figure  2:  Positioa  Coastrai&t  Between  Two  Deformed  Elementi. 


tr&niformAtion  metrix  from  the  deformed  to  the  undeformed  elemettal  orientation  of  the 
node  under  conaiderntion,  nnd  J  it  n  fixed  offtet  vector  between  the  two  elements  reUtive 
to  the  first  element’s  undeformed  coordinate  system.  In  general*  J  is  used  to  model  the 
offset  which  is  often  present  In  a  pin  j^t. 

The  variable  correlation  table  and  the  position  constraint  equations  presented  In  this 
section  are  sufficient  for  defining  the  spatial  configuration  of  most  mechanisms.  Similar 
slope  and  curvature  constraints  may  also  be  needed  in  order  to  fully  define  the  configuration, 
and  insure  the  compatibUity  between  the  various  elements  of  a  m'dtibody  system. 

S^3.2  Sy$Um  of  CctutratnU.  The  ^obal  system  of  constraints  equations,  I,  is  defined  as 
the  total  number  of  constraints  required  by  the  configuration  and  node  types  of  a  particular 
mechanum.  Given  tlus  system  of  construnts,  in  the  form  of  Equation  (I6)i  the  following 
most  hold  for  ail  time, 

1  =  0 
I  =  =  0 

I  =  =  0  (26) 

where  the  coustraint  jacobian,  J,  is  defined  as,  J  =  d4/ffQv  and  Q  are  the  ^obal  degrees 
of  freedom  of  the  mechanism.  These  a>cstraints  are  introduced  into  the  global  system  of 
equations  in  the  following  section  using  Lagrange  multipliers.  These  equations  are  subse¬ 
quently  used  to  ehmioato  the  L^ange  multipliert  &om  the  dynamical  system  of  equations 
for  a  flexible  mechanism. 


(24) 

(25) 


2M 


4  System  of  Equations  of  Motion 


Up  to  this  point,  the  differential  equations  of  motion,  Equation  (14),  only  appbes  to  a 
single  finite  element.  The  equations  of  motion  for  the  entire  mechanism  are  determined  by 
assembling  the  elemental  equations  into  the  ^obal  equations,  usmg  the  variable  correlation 
table,  and  incorporating  the  constraint  Jacobian,  J,  using  Lagrange  multipliers  such  that, 


+  cq  +  KQ  +  J^'a  =  F 


(27) 


where  the  vector  Q  contains  the  degrees  of  &eedom  of  the  entire  mechamsm,  and  A  is  the 
vector  of  Lagrange  multipliers  corresponding  to  the  constraint  functions.  By  adding  the 
constriunt  acceleration,  Equation  (2$),  this  equation  can  be  rewritten  as, 


0 


F-CQ-KQ 

-j4 


F- 


Solving  for  Q  and  X, 
f  X 


q  ]  _  r  M  J'  1"  f  F’. 
,  A  j  "  I  J  0  J  [ 


(28) 


(29) 


By  computing  the  inverse  of  the  expanded  mass  matru;  using  the  inverse  by  partitions 
method,  or  by  solvi*ig  Equation  (27)  for  Q  and  substituting  it  into  Equation  (26),  it  can 
be  shown  that, 

A  =  +  (JM-'J'']"' (39) 

substituting  rbis  equation  back  into  Equation  (27)  and  solving  for  results  in, 

^  =  M-'r-  [jM-'J’’]"'  f’-  [m-'.7^]  j(5  (31) 

This  system  of  second  order  ordinary  dfferentisi  equations  of  motion  satisfies  the  con* 
straints  without  the  need  to  include  the  Lagrange  multipliers,  thereby  not  increasing  the 
size  of  an  already  large  problem.  This  technique  will  be  used  to  solve  for  the  elastic  de> 
lormaticns  as  well  as  the  rigid  body  motions  of  a  general  flexible  mechanism  or  multibody 
system. 

4.1  SOLUTION  TECHNIQUE 

In  the  previous  sections,  the  general  formulation  of  the  global  system  of  equations  of  motion 
for  a  general  flexible  mechanism  was  prevented.  The  matrices  M,  C,  K  and  the  forcing 
vector  F  in  Equation  (31)  are  nonlinear.  Because  these  equations  are  nonlinear  and  the 
tran<ieot  solution  is  dec'red,  numencal  tecbmques  are  used  to  solve  the  global  system  of 
equations. 

Equation  (31)  is  the  system  of  second  order  ordinary  difierentiai  equations  ivhich  wui 
be  solved.  But,  in  order  to  solve  these  equations,  they  must  first  be  ^'written  as  a  set  of 


f  I: 
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first  order  oidinary  dlfferentiai  equations  which  caA  then  be  numerically  integrated  by  most 
standard  ODE  solvers.  This  is  done  by  defining  V  such  that, 

-I.  =  -  [M->jT](jM->JJ-]“jl5)  (32) 

V  .  - - -  - - -  -  -  .. 

[  *5 

This  equation  was  solved  using  the  LSODE  routine  from  the  ODEPACK  library.  LSODE 
uses  a  12*^  Cider  Adams*Moultott  method  to  solves  a  system  of  ordinary  differential  eqna* 
tions. 


5  Rigid  Double  Pendulum  Example 

A  driven  crank  rigid  double  pendulum  example  is  presented  in  this  section  to  illustrate 
the  position  constraint  functions,  and  solution  technique  presented  in  this  paper.  Figure  3 
illustrates  the  rigid  double  pendulum  model  for  this  example.  Each  link  of  the  pendulum 


<1 


_ 


^ ^ 


Figure  3:  Rigid  Double  Pendulum  Model. 


Length  of  the  bnks  i  /|  and 

1.00 

Cross  Sectional  Are4  (  A 

0.10 

Mass  Density  ( p 

1.00 

Concentrated  Mass,  me  (  m 

0.10 

Table  1:  Geometric  Properties  of  the  Rigid  Double  Pendulum. 

is  considered  to  be  a  separate  element.  Both  of  these  elements  have  a  rigid  body  rotational 
degree  of  freedom,  and  ^2,  and  the  second  link  has  ri(pd  body  position  degrees  of  freedom, 
X  and  Z.  The  ri^d  body  position  degrees  of  freedom  of  the  second  link  Mf  equated  to  the 
position  of  the  second  node  o^ the  first  element  u^g  a  position  constraint.  Thi  m./del  also 
has  concentrated  masses  at  the  nodes  and  u  subjected  to  a  gravitational  force,  as  indicated 
in  Figure  3.  Other  than  the  concentrated  masses,  both  links  have  identical  material  and 
geometric  properties,  as  shown  in  Table  1. 
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The  exact  second  order  nonlinear  ordinary  differential  equations  of  motion  for  a  free 
vibrating  double  pendulum  are  given  m  [2$»26).  For  this  example  m  =  mj  =  m2  s  0.1, 
li  sljs:  1.0,  and  mei  =  mcs  =  2m.  By  substituting  these  values  for  the  link  lengths  and 
masses,  into  the  equations  of  motion  for  a  double  pendulum,  the  exact  system  of  equations 
of  motion  for  the  rigid  double  pendulum  studied  in  this  example  is  defined  as, 

r  +  |mcos(52-^i)®3  -  fmain(62“tfi)^2  +  ^mpsindj  1  _  « 

[  3mtf2  +  |mco5(^2  -  ^i)^i  +  5msin(tf2“^i)^i  +  ]  ~  ^  ^ 

The  solution  of  these  equations  is  compared  to  the  solution  obtained  from  the  program 
developed  in  this  study.  For  this  example  the  pendulum  was  given  a  driving  function.  The 
driving  function  was  a  constant  angular  velodty,  applied  to  the  first  link  of  the  pendulum, 
.  The  initial  position  of  the  pendulum  was  $t  ss  $2  —  0  &nd  the  bnks  were  given  initial 
velocities  of  6\  =  lOrod/scc  and  6^  s  Qrad/see,  respectively.  The  constant  angular  velocity 
for  was  achieved  by  applying  an  acceleration  constraint  of  =  0  over  the  entire  time 
duration  of  the  simulation.  This  example  was  run  for  a  3.0  second  duration  An  integration 
tolerance  of  1.0E*08  was  used  and  3001  data  points  were  obtained  at  intervals  of  0.001 
seconds  in  5.08  CPU  seconds,  00  an  IBM  RISC  System/6000  Model  550  workstation  running 
AIX  Version  3.1. 


Figure  4:  Driven  Rigid  Double  Pendulum  Time  History. 


Figure  4  shows  the  time  history  for  the  first  four  complete  revolutious.  The  positions 
illustrated  in  this  figure  are  at  intervals  of  0  015  seconds  In  this  figure,  the  numbers  1, 
2,  3,  and  4  indicates  the  consecutive  revolutions  and  the  arrows  indicate  the  direction  of 


motion.  The  first  two  revolutions  shown  in  this  figure  dearly  illustrate  the  effect  gravity 
has  on  the  system.  The  second  link  lags  behind  the  first  link  on  the  up^swings  and  leads 
on  the  down^swmgs.  The  third  and  fourth  revolutions  show  the  full  effects  of  this  as  the 
second  link  folds  back  on  the  first  link.  This  is  further  illustrated  in  Figure  5,  which  is  a 
plot  of  the  endpoint  of  the  pendulum.  This  plot  dearly  shows  the  stall  points  m  the  third 
and  forth  revolutions,  and  the  second  Unk  folding  back  on  the  first  link  Given  the  initiai 
conditions  for  this  example,  the  results  from  Equatbn  (33)  are  identical  to  those  illustrated 
in  Figures  4,  and  5. 

Orl«*A  P«n4u)w*  Ca4  PaIaI 


Figure  5:  Driven  Ripd  Double  Pendulum  Endpoint  Results. 


The  rigid  double  pendulum  example  presented  in  this  section  shows  that  the  rigid  body 
aspects  of  the  formulation  presented  in  this  study  are  exact.  It  also  shows  that  the  use  of 
the  position  and  acceleration  constraints  is  viable  for  rigid  models.  More  importantly  this 
example  shows  that  the  Lagrange  Multipliers  can  be  solved  for  directly  and  substituted 
back  into  the  on^al  dynamical  system  of  equations,  without  any  loss  of  data  or  accuracy, 
and  subsequently  decreasing  the  size  of  the  problem  to  be  solved.  This  same  pendulum  is 
now  considered  to  bvi  flexible  in  order  to  show  that  these  statements  are  valid  for  systems 
containing  ri^d  as  well  as  fleidble  modes  of  vibration. 

6  Flexible  Double  Pendulum 

In  this  section  the  model  used  for  the  n^d  double  pendulum  example  was  considered  to 
be  flexible.  The  example  presented  m  this  section  will  veniy  the  developed  methodology’s 
capability  to  handle  models  which  contain  both  flexible  and  rigid  modes.  The  model  used 
for  the  rigid  double  pendulum  example,  Figure  3,  is  given  flexible  degrees  of  freedom  and 
material  properties  in  this  case,  which  would  promote  large  deformations. 


Figure  6  illustr&tes  the  flexible  double  pend'iium  model  which  is  an  extension  of  the  rigid 
model,  and.  as  with  tne  rigid  example,  this  example  is  also  subjected  to  a  gravitational 
force.  The  physical  and  material  properties  for  this  flexible  pendulum  example  are  listed 
in  Table  2 


Figure  6.  Flexible  Double  Pendulum  Example  Model. 


length  of  the  bnks  I  ii  and  h 

" 

1.00 

Cross  Sectional  Area  I  A 

0.10 

Momeatt  of  laerti,J  I  1„ 

l.OE-02 

Mass  Density  ( p 

l.UO 

Concentrated  Mass  |  m 

0.10 

Modulus  of  elaitiaty 

l.OE+04 

Shear  modulus 

Gnihn‘) 

1.0E+05 

Table  2:  Geometric  and  Material  Properties  for  the  Flexible  Pendulum. 


This  example  was  run  with  a  $pia>up  maneuver  which  result  in  $\  =  lO.Orad/sec  for 
t  >  l.Osec.  The  pendulum  started  at  rest,  with  the  axial  deformations  equal  to  the  static 
deformations  which  result  under  the  present  gravitational  force  and  an  initial  position  of 
s  0  radians. 

The  spin«up  maneuver  for  this  example  was  ac«>mphshed  by  specifying  an  acceleration 
constraint  of, 

s  f  10.0+ I0.0cos(xt)  0.0<l<1.0 

Given  this  constraint  equation  and  initial  conditions,  this  case  was  run  for  6.0  seconds.  An 
integration  tolerance  of  l.OE-06  was  used  and  6(M)1  data  points  were  obtained  at  intervals 
of  0.001  seconds  in  2948.18  CPU  seconds. 

Figures  7  and  8  shows  the  time  history,  at  intervab  of  0.015  seconds,  for  the  first  eight 
revolutions  of  the  pendulum.  The  consecutive  revolutions  and  the  direction  of  rotation 
are  Indicated  by  I, '  •:•,$  and  the  arrows.  Figures  9  and  10  show  the  axial  and  transverse 
deformations,  resp<^tively,  of  the  elements  In  both  of  these  plots  the  solid  lines  are  the 
results  for  element  I  and  the  dashed  lines  are  the  results  for  element  2.  These  flgures 
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shows  that  the  first  link  is  subjected  to  axial  and  transverse  deformations  of  15%  and 
30%  of  the  link  length,  respectively.  As  is  expected,  the  deformations  of  the  first  element 
are,  in  general,  larger  than  those  of  the  second  element.  The  axial  deformations  are  larger 
because  the  first  link  is  subjected  to  the  additional  centrifugal  force  because  of  the  mass 
of  the  second  Unk.  The  transverse  deformations  are  higher  than  those  of  the  the  second 
link  because  the  first  element  is  subjected  to  the  torque  required  to  cause  the  prescribed 
motion,  and  thus  an  additional  moment  at  the  base. 

This  example  illustrates  that  the  methodology  developed  m  this  study  Is  more  than 
capable  of  handling  problems  which  contain  both  flexible  and  rigid  body  motion.  It  also 
shows  that  the  position  constraint  functions  work  when  flexible  and  ripd  body  modes 
are  present.  The  examples  presented  up  to  this  point  show  the  that  model  developed 
in  this  study  is,  in  theory,  valid.  Now  an  example  will  be  presented  which  is  compared  to 
experimental  results  in  order  to  verify  the  developed  model’s  capability  to  accurately  model 
the  response  of  actual  high-speed  flexible  mechsnisms. 

7  PUnar  Four-Bar  Mechanism 

The  example  presented  in  this  section  is  a  four-bar  mechamsm  whose  expenmental  results 
are  ^ven  by  Sutherland  in  (27].  This  four-bar  mechanism  is  Illustrated  in  Figure  U.  The 
results  obt^ned  from  the  developed  program  are  compared  to  experimental  results  in  tbit 
section.  This  was  done  m  order  to  verify  the  capability  of  the  methodology  presented  In 
this  study  to  accurately  model  the  response  of  high-spe^  flexible  mechanisms. 


Figure  11:  Planar  Four-Bar  Mechanism  Model. 


Figure  11  illustrates  the  fully  flexible  four-bar  mechanism  which  contains  all  of  the  r^e- 
vant  rigid  body  and  flexible  degrees  of  freedom.  The  physical  and  material  properties  of  this 
mechanism  are  bsted  in  Table  3.  For  the  case  presented  in  this  section  the  mechanism  was 
started  from  rest  with  all  deformations  equal  to  zero  and  an  initial  crank  an^e  of  ~  0  ra¬ 
dians.  The  actual  operating  speed  used  in  the  experiment  was  not  known  for  this  problem. 
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*  M 


1 

Crank 

Coupler  1  Follower  | 

Modulus  of  Elasticity 
{£(  Ib/tn^)] 

15  0QE+06 

15  00£-t-06 

15.00E*f06 

Mass  Density 
U((6jV.n<)| 

7  920E-04 

7.920E-C4 

7.92CE-04 

Link  Area 
(A(.r.’)l 

2.344B-02 

2.344E-2 

2.344 E-02 

Moment  of  inertial 

3.827E-05 

3  827E-05 

3.827E-5 

Link  Length 
(i(>n)l 

TomE+oo" 

l.OOOE-1-01 

l.OOOE+01 

Mass  at  Node  1 

O.OOOE-f-00 

1.0  ,0E-05 

OOOOE-fOO 

Mass  at  Node  2 

1  OOOE-05 

1  OOOE-05 

l.OOOE-05 

Length  of  the  biise  hnk  =  13.55  m. 

Table  3:  Geometric  Properties  for  the  Flexible  Four>Bar  Mechanism. 

By  using  the  information  available  in  [27)  the  operating  speed,  was  determined  to  be  in 
the  range  23  <  0  <  26  rad/see.  This  example  was  run  at  various  operating  speeds  in  this 
range.  In  order  to  achieve  a  desired  operating  speed  a  spin*  up  maneuver  was  performed. 
Then  the  mechanism  was  nm  at  the  desired  constant  velocity  The  spin*up  maneuver  for 
this  example  was  accomplished  by  specifying  an  acceleration  constraint  of, 


^  +  dcos(jrt) 

0.0 


0.0<l<  l.O 
t>  1.0 


(35) 


In  order  to  promote  stability  and  simulate  material  damping,  a  nominal  damping  factor 
of  f  s  0.000002  was  used  for  each  case.  Given  the  damping  coefficient  and  the  initial 
conditions  this  four-bar  mechamsm  was  run  at  operating  speeds  of  9  =  22,  23.  24,  25,  26, 
and  27  rad/see.  Each  case  was  run  for  a  time  which  corresponded  to  10  full  revolutions, 
after  the  completion  on  the  spin-up  maneuver.  An  integration  tolerance  of  I  OE-06  was 
used  and  500  data  points  were  obtained  for  each  full  revolution  at  intervals  corresponding 
to  the  operating  speed.  The  average  CPU  time  for  th«s«  raises  was  1100  CPU  seconds 

The  problem  reached  a  steady-stoic  response  after  3-4  revolutions.  The  operating  speed 
was  properly  bracketed  to  be  in  the  24-25  rad/sec  range.  Figure  12  shows  the  results  for 
0  s  24  In  this  figure  the  sobd  line  is  the  for  the  fifth  revolution  and  the  dashed  line  is  the 
experimental  results.  This  figure  shows  that  the  results  compare  extremely  favorably  with 
the  experimental  results,  especially  considenng  the  fact  tbnt  all  the  links  are  flexible  and 
are  undergoing  large  deformatioos. 

This  example  verifies  that  the  methodology  which  has  been  developed  during  this  study 
IS  capable  of  handling  models  wnich  contain  flexible  and  rigid  body  motion  It  also  shows 
that  the  developed  methodology  can  accurately  model  the  nonlinear  response  of  high-speed 
flexible  mechanisms  with  just  a  few  elements.  The  solution  technique  for  handling  con¬ 
straints.  presented  in  this  paper,  has  also  proven  to  be  a  good  alternative  to  the  classical 
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methods  for  modebng  constrained  multiboay  systems. 


£x«*dI«  Results  24  rad/sae 


C#«Kk 

Figure  12:  Results  for  Sutherland's  Four*Bar  Mechanism  Example,  $  s  24 


8  Conclusions 

The  examples  presented  in  this  paper,  and  those  pven  in  reference  [25],  show  that  the 
technique  developed  m  this  research  is  capable  of  determining  the  exact  rigid  body  motion 
of  a  mechanical  system.  It  is  also  able  to  calculate  large  deformations  combined  with  rigid 
body  motion.  This  was  verified  through  comparisons  with  both  analytical  and  experimental 
results  of  others.  More  importantly  the  technique  for  handling  constraints  presented  in 
this  paper  has  proven  to  be  an  effective  alternative  to  the  classical  methods  for  modeling 
constrained  multibody  systems.  Although  the  method  involves  determining  the  inverse 
of  the  ma'ii  matrix  M,  and  the  matrix  these  inverses  can  be  calculated  very 

efUciently  since  the  mass  matrix  is  symmetric  and  normally  quite  sparse.  This  method  also 
avoids  having  to  calculate  the  Lagrange  muitiphers  and  the  constraint  equations. 
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ABSTRACT.  This  paper  presenU  use  of  the  non^symmetne  Lanezos  Ugonthm  in  order 
to  solve  the  eigenvalue  problem  of  a  flexible  mechanism  around  a  determined  configuration. 
The  algorithm  is  implemented  the  MSCANO  software  which  aims  at  investigating  the 
behavior  of  flexible  and  ri^d  <ncchamsmf  u*:ng  the  finite  element  approach. 

1.  Introduction 

In  the  context  of  multibody  dyuami^,  eigen>  due  analysis  is  mainly  used  to  investigate 
the  stability  of  the  physical  »yv>iA.  Theusr  the  fiVta  element  method  involves  the  handling 
of  large  sparse  system  matures.  When  thege^''.ietxlc  non*lineanty  and  physical  phenomena 
such  as  gyroscopic  and  ay  fiktior  effects  are  taken  into  account,  the  assumption  of 
symmetric  positive  definite  systejz  mat.ices  is  no  longer  valid.  The  use  of  a  general 
algorithm  'br  solving  the  eigen-aiue  proInjM  \s  then  required.  The  objective  of  the  paper 
is  to  propose  such  an  algorithm.  The  first  part  of  the  paper  briefly  presents  some  general 
aspects  of  the  MECANO  softwato  in  which  the  algorithm  is  implemented.  Th  *  m  ud  part 
mainly  deals  with  the  algorithmic  aspects  of  the  non-symmetric  Lanezos  algorithm.  The 
last  part  presents  some  preliminary  results  of  the  implementation. 

2.  General  Aspects  of  the  MECANO  Software  ([S],  [6]) 

The  MECANO  software  is  a  spiisUHv  module  of  the  i^eneral  purpose  finite  element  code 
SAMCEF.  Based  on  the  finite  element  concept ,  it  provides  an  answer  to  mu*  stnal  require¬ 
ments  m  the  field  of  flexible  articulated  system  analysis. 
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The  mechanism  is  described  m  teitwS  of  absolute  coordinates.  The  flexible  members,  rigia 
bnks  and  mjcnamcsi  joints  are  corsidered  as  individual  elements  of  a  large  library  of 
co.'uponents.  The  *cpo!ogy  of  the  mechanism  is  thus  impliutly  contained  in  the  flmte 
element  mesh  describing  the  system.  Tins  method  of  modeling  is  not  penalized  by  multi- 
connected  topology  or  dosed  kinematic  loops  and  provides  a  simple  and  clear  data  set 
Integrated  n  a  larger  flnite  element  concept  by  the  substnictunng  technique,  it  allows  to 
mode)  acy  type  of  flexible  link  with  arbitrary  chape.  Making  use  of  the  ctistomired  function 
and/or  the  user  element^  the  software  also  allows  to  model  excitations  and/or  components 
v.hich  are  not  standard  in  the  element  library. 

The  system  of  motion  equations  is  derived  from  Hamilton's  principle  and  assembled  m 
sparse  form  in  order  to  handle  effldently  very  large  models.  The  augmented  Lagrangian 
method  takes  into  account  the  constraints  on  the  system.  The  augmented  Lagrange's 
functional  is  described  as  follows  r 

r  =  £(q)-lrA’'(^+|#||>  (21) 


'Inhere 


-  C  ’•%  the  lagrangian  of  the  mechanism, 

>  q  IS  tb«  generalized  coordinate  vector  described  in  the  absolute  frame, 

•  tb  is  the  constraint  vector  and  A  the  Lagrange's  multipliers. 

-  h  and  p  are  respectively  scaling  and  penalty  factors.  They  vary  m  terms  of  the 
generabzed  stiffness  of  the  mechanism.  The  application  of  Hamilton’s  principle  to 
(2.1)  yields  to  the  following  DAE  system  : 


|Mq  r  R'^(iA  +  p<l>)  =  g(q,q,l) 

U^(q.O  =  P 


(2.2) 


If  A*)  is  an  approximated  solution  of  the  system  (2.2)  at  time  t,  expressing 

the  correction  at  (t  +  Af) 

(q'  4-  Aq,q*  Aq,  V  +  AqjA"  t  A  A) 

allows  to  obtain  the  bneanzed  system  of  equations  in  the  form  : 

(MAq  +  CAq  +  SAq  +  iB^AA  -  r* 

{  (2.3) 


ItBAq  =  -k6' 


i 
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where  M,  C  and  S  are  respectively  the  mass,  damping  and  stilfness  tangent  matrices 
They  are  sparse  matrices  assembled  under  skybne  form  and  are  also  unsymmetric  due 
to  the  gyroscopic  effects  and  dry  friction  forces.  M,  C  and  S  depend  on  the  generalized 
coordinates  and  on  their  derivatives. 

3.  Nonosymmetrie  Lanezot  Algorithm 


3.1.  GENERAL  PROBLEM 


The  general  solution  of  the  system  of  equations 

Mq  +  Bq  -i-  Kq  =  0  (3.1) 


can  be  expressed  as 

q(t)  =  qe^‘  with  p  x  a  +  »w 

where  o  is  denned  as  the  damping  coefficient  and  w  is  the  natural  frequency.  In  terms  of 
the  state  vector  (q  pq),  equation  (3.1)  may  be  rewritten  as  a  first  order  system  of  equations 


The  standard  form  of  the  eigenvalue  is  then  obtained 

A  X  =s  XBx  with  ^  “  (3.3) 

When  all  the  kinematic  and  parasitic  ngid  modes  are  filtered  out,  matrix  5**^  exists  and 
equation  (3.3)  Is  then  expressed  as  ft^ows 

Cx  =  Ax  with  C  =  B~^A  (3.4) 


Since  C  is  unsymmetric,  the  eigenvalue  problem  admits  different  eigensolutions  to  the  left 
denoted  z  and  to  the  right  denoted  x.  Ortbc^onality  of  eigenst^utions  is  expressed  between 
z  and  X.  The  general  problem  and  its  orthogonality  conditions  can  be  written  as  follows 

iCx  =  Ax  thi  nght'hand  problem 

C^z  3s  Az  the  left-hand  problem 
with  the  orthogonality  relationships 


(3.0) 


IZ'CX  =  J 
Iz^'x  =  AJ 


(3.6) 
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where  A  is  a  diagonal  matrix  collecting  the  eigenvalues  A,  and  J  is  a  signed  unit  matrix 
(si  on  the  diagonal).  X  and  Z  contain  the  eigenvectors  of  the  problem 

3.2  NON-SYMMETRIC  LANCZOS  ALGORITHM  ((l],(7]) 

The  non«symmetric  Lanczos  algorithm  is  a  generalization  of  the  well<known  Lanczos  sym* 
metric  scheme.  The  m^in  advantage  arises  from  the  fact  that  the  orthogonal  sequences  of 
Iterates  ate  built  up  from  iterations  on  only  one  left>hand  and  one  right-hand  iterate  at  a 
time.  In  the  .{eneral  case,  the  algorithm  may  be  formulated  as  follows 

a.  Choice  of  right-  and  loft-hand  starting  vectors  d  and  in  the  form 


'uo' 

Vo' 

do  = 

and  go  =  0 

.Vo. 

.^0. 

where  uq  and  vo  are  arbitrarily  generated.  In  order  to  satisfy  the  constraints  of  the 
system,  it  is  necessary  to  perform  one  power  iteration  on  and  do  before  the  beginning 
of  the  Lanczos  iteration. 

b.  Povtr  Iteration  ;  the  inverse  iterations  are  then  performed  on  both  left*  and  right-band 
vectors 

=  Cdfc  and  =  C^g*  (3.8) 


c.  Biorthonormah^tation  of  3  ond  d 


7k.|.ldHl  =  ^fc+l  -  -  /?k-|dk-i  = 

7k+i«k+.i  -  ?*+i  -  -  ^J-idk-i  =  gk+i 


(3  9) 


The  orthonormality  condition  between  the  left-  and  the  right-hand  iterates  allows  to 
compute  the  coefficients 


Id.+Zg,  =  0 
«»+/<*)  =  0 
.for  j  <k 


a.  =  Qj  =  e.g.^Cd. 

A  =  A*  =  lkCktk-\ 

_  (3.10) 

71  =  v'lg.’''<i*'l 

tk  =  g.’^d.  =  ±1 
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Under  m&trix  form,  equation  (3.9)  is  then  expressed  as 

(CD*  =  D*T*  +  (0,...,0.d:^.O 
=  G»Tt  +  (0,.  ..,0,gl^,) 
where  T  is  the  non-symmetnc  tridiagonal  matrix 


(3  11) 


QO  ^  0 

7l  ai  /Ji  0 

0  -n  012  02 


0k~i 
"Ik  Ttk 


d.  5o/tin^  the  interaction  problem 

The  interaction  eigenvalue  problem.  U  then  written  m  the  form 

J*T*r  s  AJhr  and  T*J*$  s  AJ*t 

with  the  matrix 

J*  =  d»oy(e*) 


(3.12) 


The  HQR  algorithm  allows  then  to  perform  the  eigenvalue  analysis  of  (3.12).  The  left* 
and  right-hand  eigenvectors  of  the  original  problem  are  then  restored  m  the  form 


X  s  D*r  and  a  s  G*s 
The  associated  Rayleigh  quotient  is  computed  in  the  form 


(3.13) 


A  = 


z^Cx 


and  provides  very  fast  convergence  to  the  eigenvalues  of  C. 

The  Iteration  pro^dure  is  stopped  when  either  the  allowed  number  of  iterations  is  reached  or 
the  convergence  cnterion  is  satished  ([7)).  During  the  iterative  procedure,  the  orthogonality 
between  the  left  and  right  sequences  is  rapidly  l<»t.  It  is  thus  necessary  to  use  the 
orthogonalization  procedure  of  Cram-Schmidt  in  order  to  recover  the  orthogonelity  which 
increases  significantly  the  computational  cost  of  the  algontbm. 
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Let  us  finaly  note  that  in  case  of  multiple  dgenvalues,  the  Lanczos  algonthm  allows  to 
obtain  only  one  eigenmode  at  a  time,  the  extraction  of  multiple  eigenvalues  can  not  be 
performed  without  a  restarting  of  the  algonthm.  The  new  starting  vectors  and  go  are 
chosen  orthogonal  to  the  previously  converged  iterates.  The  restart  procedure  ought  to  be 
performed  several  times  in  order  to  extract  all  the  eigenmodes  of  a  multiple  frequency  [7]. 

3  3.  FILTERING  OF  RIGID  BODY  MODES  AND  PARASITE  MODES 


The  existence  of  ri^d  body  and  kinematic  modes  is  indicated  by  a  rank  reduction  of  the 
matrix  B.  Two  solutions  are  proposed  for  solving  this  problem  to  perform  the  eigenvalue 
analysis  m  the  presence  of  singularities. 

S.3,l  Filtering  Operator.  This  method  is  elegant  and  powerful  but  reqvre  the  a  prion 
determination  of  the  rigid  modes  U.  The  filtering  operator  V  is  then  built  as  fellows . 

P  =  witb  =  [^^  °] 

The  rigid  body  modes  are  filtered  out  if  the  ortht^nality  condition  is  respected 

{U^MDi  s  0  for  the  nght'hand  problem 

(3.14) 

Gf  U  s  O  for  the  left-hand  problem 

where  the  subscript  (t)  denotes  the  real  part  of  the  iterates.  The  condition  (3.14)  is  fulfilled 
by  use  of  Gram-Schmidt  orthogonalization  procedure.  The  computation  of  U  is  however 
difficult  when  the  skylme  form  of  the  tangent  matrices  must  be  respected. 

S.3.2  Positive  Shifting.  If  p«  is  a  shift  parameter,  the  solution  pt  =  p  +  p,  allows  to 
express  the  characteristic  equation  (3.1)  as 

M(q)q+  B‘(q)q  +  K‘(q)q  =  0  (3.15) 

where 

B*  =  B  +  2p,M, 

K'  =  K  +  p.B  +  pjM 

This  method  is  simple  and  effiaent,  it  does  not  alter  the  skyline  form  of  the  M,  C  and  K 
matnees  Nevertheless,  the  choice  of  the  shift  parameter  p«  remains  difficult  and  ’’jump” 
may  occur  over  some  eigenfrequencies. 


! 


i 

( 
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At  the  present  time,  only  the  positive  shifting  procedure  h&s  been  implemented  in  the 
algorithm 

4.  Stability  Analysis  of  a  Helicoidal  Spring 

The  sysiem  to  be  analyzed  is  a  helicoidal  spring  designed  to  start  a  turbopump  (figure  4.1). 
The  cross  section  of  the  wire  is  rectangular.  The  upper  and  the  lower  sides  of  the  spring  are 
constrained  on  two  parallel  planes  whose  distance  is  hxed.  When  the  spring  is  loaded  by 
a  torque  C  onto  its  upper  end,  the  main  deformation  cf  the  turn  implies  coupling  between 
bending  and  torsion  and  induces  strong  geometric  nonlinearities.  The  goal  of  the  analysis 
to  deterimne  the  buckling  load  Cb  for  which  the  spnng  turns  are  warped. 

The  spring  is  modeled  by  37  beam  elements  with  rectangular  cross  section  It  is  made  of 
steel.  The  total  number  of  degrees  of  freedom  is  222.  Figure  4.2  presents  the  finite  element 
model  of  the  system.  The  lower  end  of  the  spring  is  clamped  and  a  torque  is  appbed  onto 
the  upper  end  in  the  axial  direction.  The  incremental  static  analysis  is  performed  until 
buckling  occurs.  When  the  spring  is  warped,  its  turns  axe  twisted  and  the  analysis  diverges 
by  numerical  instability.  In  order  to  determine  precisely  the  budding  torque,  tbe  load 
increment  is  refined  at  the  eud  of  the  analysis. 

An  eigenvalue  analysis  is  performed  after  every  3  increments  to  determine  the  residual 
stability  of  the  system.  Buckling  can  be  detected  as  the  moment  when  the  first  vibration 
frequency  of  the  system  becomes  zero. 

Figure  4.3  shows  an  intermediate  configuration  and  the  buckled  one.  Figure  4.4  displays 
the  rotation  angle  versus  the  applied  torque,  showing  that  the  spring  response  is  bneax 
up  to  bifurcation.  Figure  4.5  shows  the  evolution  of  the  first  five  eigenfrequenues  versus 
appbed  torque  C.  Under  extenial  load,  the  system  is  very  sensitive  to  nonbnear  geometric 
effects  and  one  notes  the  contineous  decrease  of  the  first  eigenfrequency  with  the  torque.  A 
rapid  decrease  is  observed  just  befor  tbe  occurence  of  the  buckling  phenomenon 

5.  Conclusion 

The  non>symmetric  Lanczos  algorithm  is  an  effident  tool  to  investigate  the  stabibty  of 
flexible  mechanisms.  It  permits  to  take  into  account  tbe  influence  of  tbe  mechanical  effects 
introduced  by  the  modebng  of  the  gyroscopic  effect  and  of  the  dry  friction.  Improvements 
such  as  an  acceleration  technique  by  use  of  Chebychev  polynomials  [3]  would  still  render  it 
more  attractive.  The  ^gorithm  is  stiU  under  test  on  more  general  examples. 
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Abstract 

The  study  of  freC'flostiBS  msstpuUtors  u  impotunt  for  the  success  of  robotics  programs  in 
space  and  in  the  design  of  innovative  robot  systems  which  can  operate  over  a  large  worbpace  In 
order  to  study  the  fundamental  theoretical  and  experimental  issues  encountered  in  space  robotics, 
a  closed'chain  planar  manipulator  was  bult  at  Ohio  University  (OU)  which  floats  on  a  flat  table 
using  air  beanngs.  Due  to  the  absence  of  external  forces  in  the  plane  of  the  table  and  couples 
normal  to  this  plane,  (he  linear  momentum  in  the  plane  and  the  angular  momentum  normal  to 
this  plane  are  conserved  It  is  well  known  that  the  linear  momentum  equations  are  holonomic 
while  the  angular  momentum  equation  is  nonholonomic  Due  to  this  aonholonomic  behavior, 
the  path'planung  schemes  commonly  used  for  fixed*base  manipulators  do  not  directly  apply 
to  free-floating  manipulators  la  this  paper,  we  present  an  algonthm  for  motion  planning  of 
planar  free-floating  maupuUtors  based  on  the  inverse  position  loaematics  of  the  mechanism.  It 
u  demonstrated  that  the  inverse  position  kinematics  algorithms,  commonly  used  for  fixed-base 
manipulators,  can  be  succestfully  applied  to  free-floating  mampulaiors  using  an  iterative  search 
procedure  to  satisfy  the  nonholonomic  angular  momentum  conatraints  This  procedure  result  in 
paths  identical  to  (hose  predicted  by  inverse  rate  kinematics  The  inverse  position  bnemaltca 
algorithm  is  (hen  used  to  avoid  singulanties  dunng  motion  to  result  in  successful  paths  The 
results  of  the  simulation  of  this  algorithm  using  parameter  estimates  of  the  OU  free-floating  robot 
are  presented 

1  Introduction 

Satellite-mounted  manipulators  will  play  an  important  role  in  the  construction  of  the  space  station 
and  in  the  future  missions  for  space  inspection  and  repair  Over  the  last  decade,  several  research  have 
been  reported  on  manipulation  systems  which  have  free-Roatiog  base  Longman  et  al  [7]  presented 
a  way  to  control  the  end-effector  trajectories  accounting  for  base  motions  Umetani  and  Yoshida 
^[13],  [15])  presented  the  notion  of  generalucd  Jacobians  and  suggested  an  algorithm  for  dual-arm 
coordination  of  frce-floatmg  manipulators  Alexander  and  Cannon  [5]  reported  experimental  results 
on  a  free-floating  manipulator  Vafa  (14]  presented  the  useful  concept  of  'virtual  manipulators’  ap¬ 
plied  to  open-chain  floating  manipulators  Papadopouks  and  Dubowsky  ([9],  [10])  studied  control 
algorithms  and  dynamic  singularities  of  free-floating  manipulators  Schneider  and  Cannon  [ll]  pre¬ 
sented  a  strategy  for  cooperative  manipulation  of  floating  robots  Agrswal  et  al  [2]  repotted  studies 
conducted  on  singularities  of  the  Jacobian  mapping  of  free-floating  open-chain  manipulators  They 
also  reported  research  conducted  on  workspace  boundaries  of  free-floating  closed-chain  manipulators, 
and  algorithms  lor  dynamic  simulation  of  these  manipulators  ((1],  [3])  Mukherjee  and  Nakamura  [8] 
proposed  path  planning  algorithms  for  space  manipulators 


Figure  1  A  3«D  »cli<i  mod<}  of  a,  rtte»floaUDK  cloacd^cham  maoipulfttor  bu>U  a,t  Ohio  Umversitv 


From  the  &bove  references,  it  is  well  esublished  ib&t  free*floAting  manipulators  are  chatactenred 
by  noflholonoinie  corstraints  Due  to  nonholononuc  constraints,  the  conventional  path*planning 
schemes  applied  to  fixed'base  manipulators  ate  not  directly  applicable  to  free>floating  manipulators 
The  al|orithms  proposed  in  the  literature  for  mctioo>plannmg  of  free>tloatmg  manipulators  are  either 
aimed  at  computing  the  joint  torques  using  the  dynamic  equations  of  motion  of  the  system  ([10],  [S), 
(IS),  (11})  or  the  joint  rates  using  the  ratekmeinaticsofthesvstem([8],  [4])  The  approach  presented  in 
this  paper  differs  from  these  two  motion  planning  approacnes  as  it  uses  the  inverse  position  kinematics 
of  the  system  for  motion  planning.  The  inverse  position  kinematics  is  a  well  accepted  method  for 
motion  planning  of  fixed  base  manipulators  but  it  has  not  been  explored  for  free-floating  manipulators 
due  to  the  presence  of  non  integtable  angular  momentum  constraints  In  this  paper,  we  demonstrate 
that  using  an  iterative  search  procedure  to  satisfy  the  nonholonomic  angular  momentum  constraint 
equation,  the  inverse  position  lunematics  can  be  used  for  motion  planning  of  nonholonomic  systems 
The  results  of  this  algorithm  using  parameter  estimates  of  the  OU  free-floating  robot  are  presented 
The  paper  is  organued  m  the  following  way:  A  description  of  the  OU  free-floating  closed-chain 
planar  manipulator  and  its  mathematical  model  is  presented  in  Section  2  The  position  kinematic 
equations  of  the  robot  are  developed  in  Section  3  The  rate  kinematic  equations  are  developed 
m  Section  4.  The  algorithm  for  motion  planning  using  inverse  position  kinematics  is  presented  in 
Section  b  These  are  followed  by  conclusions  of  this  study 


2  Kinematic  Model  of  the  Floating  Manipulator 

The  free-floating  planar  manipulator,  designed  at  OU,  is  a  six  revolute  jointed  closed  chain  mechanism 
A  3-D  solid  model  of  the  robot  is  shown  in  Figure  I  The  bas':  of  the  robot  floats  on  a  flat  granite 
surface  using  four  air  bearings  The  air  a  provided  by  a  compressor  mounted  on  the  base  The 
end-effector  of  this  robot  connects  to  the  base  via  two  senes  chains,  each  with  three  revolute  joints 
The  robot  has  3  degrees  of  freedom  and  is  driven  by  three  D  C  servomotors'  AH  six  joints  are 
instrumented  with  incremental  optical  encoders  The  robot  is  controlled  by  a  PC  486  machine 
equipped  with  motion  control  boards  An  overhead  X-Y  position  sensor  (not  shown  m  the  figure) 
monitors  the  position  of  a  moving  point  on  the  robot  relative  to  the  table 

‘  A  fowib  dummy  motor  is  shown  in  the  solid  modd  to  couxucrbiJence  the  mws  on  the  two  chjuns 
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Ftnufc  2  A  mathymatKal  model  of  tbe  free-floating  cto»ed»chMP  pl&o»r  manipulator 


A  mathemfttical  model  of  tha  meeh&Dtfm  along  with  the  Imk  coordinate  frames  1,$  shown  m 
Figure  2  A  coordinate  frame  ts  hxed  inertislly  at  tbe  center  of  mass  of  the  mechanism  A 
coordinate  frame  To  is  attached  to  the  base  link  (link  0)  of  the  robot  at  its  center  of  mass  The 
mass  cf  this  link  is  and  the  centroidal  moment  of  inertia  is  h  A  coordinate  frame  Tl  's  f.xed 
to  every  link  1  of  toe  chains  j  ^  A,  B  at  the  joint  where  it  connects  to  the  link  1  -  1  The  X  and  \ 
coordinate  axes  of  the  frame  Tj  are  and  y;  respectively  Tbe  relative  joint  oisplacement  between 
two  successive  frames^/.)  and  Tf  is  defined  as  ^  The  origins  of  ^1*  and  Tf  are  located  respectively 
at  1*  and  /f  from  the  origin  of  To  along  the  ico  axis  The  length  of  link  1  in  chain  j  1$  Tb'-  center  of 
mass  of  a  link  1, 1  —  1,2,  of  chain  j  is  located  at  relative  to  T(  The  end'elTector  reference  point 
P  IS  measured  in  T  by  th*  vector  r,.  Tbe  point  P  is  assumed  to  be  the  centroid  of  tne  end*effector 
link  The  mass  of  this  link  is  m,  and  tbe  centroidal  moment  of  inertia  is  The  mass  of  a  Lnk  1, 
1  =  1.2  of  chain  j  is  m{  and  its  centroidal  moment  of  inertia  is 

The  parameters  of  the  OU  free^doating  robot  computed  from  a  computer  solid  model  axe  listed 
in  Table  1  Tbe  free-livatiug  manipulator  is  described  by  nine  variables  the  three  variables  zo,  yo,  ^0 
describe  the  position  and  orientation  of  the  base  link  in  the  inertial  reference  frame  T,  th>  variables 
9*,  and  9*  describe  the  relati/e  orientation  of  the  links  of  chain  A,  and  9f ,  9f,  and  9§  are 
the  relative  orientation  the  links  of  chain  B  The  end*effector  position  is  given  by  (z.,  y«}  and  the 
orientation  of  the  line  QP  m  the  fixed  frame  by  tbe  angle  These  twelve  variables  are  the  variables 
of  interest  for  the  manipulator 

These  twreive  variables  axe  subject  to  nine  constraint  equations  The  position  vectors  r«  from  the 
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Table  1  Thg  p&ramettra  of  the  01?  ftee-flo>t>rK  fobot  comp'ited  from  a  eompufer  solid  model 


onjiQ  of  7  to  the  teferenee  p<»nt  oo  the  end-effeetot  via  cbam$  A  and  B  are 

p,  s  ro  +  f^xo  +  f^x^ +i^x^  +  /^x^ 

=  ro  +  /fxo  +  ff  xf  +  Ifxf  +  l§i§  (1) 

where  ro  is  a  vector  from  the  onfiQ  of  the  mertially  fixed  frame  to  the  origin  of  the  base  link  This 
results  in  four  scalar  equations  on  the  twelve  variables  The  angle  closure  via  the  two  chains  results 
in 


04  =  09^0^-¥0^-^-0$ 

=  0o  +  0f  +  0i  +  0l-(*  (2) 

where  q  is  the  cone  angle  of  the  cnd*effector  plate  as  shown  m  the  figure  The  linear  momentum  P 
of  the  mechanism  is* 


P  =  mjro  +  +  m^r^j  +  m,r,  +  mf  rfj  +  mfpf,  (3) 

where  to.  r,.  r^,  are  respectively  the  velocity  of  the  center  of  mass  (rf  the  links  In  the  absence  of 
external  forces  in  the  plane,  P  is  constant  Assuming  that  the  free-fioating  manipulator  is  released 
from  rest,  without  loss  of  generality,  P  =  0  The  linear  momentum  equation  (3)  is  mtegrable  On 
integrating  this  equation  and  with  the  choice  of  ^  at  the  center  of  mass  of  the  mechanism,  this 
integral  reduces  to 

moto  +  mfr^i  +  m^r^j  +  m,r,  +  mf  rfj  +  mf  pfj  =  0  (4) 

where  ri,  IS  a  vector  from  the  origin  of  ^  to  the  mass  center  of  the  link  i  of  chain  ;  One  interpretation 
of  this  equation  is  that  the  center  of  mass  of  the  mechanism  remains  at  the  origin  of  f  during  the 
entire  motion  of  the  mechanism  The  position  vectors  r{,  satisfy  the  tollowing  equation 

••1 

■<.  =  ro  +  E(W)  +  'i.’^  ■=l.  .3  ;  =  /l,8  (5) 

IsO 
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The  ajigular  momeaiym  H  about  tbc  cenief  of  it-ass  of  ‘ht  recnajiism  is  computed  by  summing 
up  the  angular  momentum  ccntributnus  from  the  individual  links  This  angular  momentum  •$ 

H  =  mo(ro  x  ro)  +  m,(r,  x  i«) 


■*  £  x  ri  +  X  rf.l 

lal 

+(/o«o +  /.».  + Dm +  E«,•‘)^ 

>zl  ;al 


Oue  to  the  pianar  structure  of  the  robot.  H  is  along  a  direction  normal  to  the  pl:ne  of  motion  of  the 
robot  In  the  ahs-nce  of  externa*  forces  m  the  pl^ne  and  couples  normal  to  the  p’anc.  ri  u  » .  onstant 
Since  the  system  starts  from  rest.  H  =  0  This  angular  momentum  etjoation  i»  not  mtegrable  and  is 
a  nonholonoimc  e^^uation 

In  summary,  the  free<i^cat<ng  manipulator  is  describ'd  by  12  variables  Tnese  12  variables  sa*- 
isfy  'igbt  position  constraint  equatioris.  four  position  loop  closure  cqns  (I),  t'vo  angle  loop  closure 
cqns  (2).  two  center  of  mass  constraint  eqns  (4),  and  one  noc-iotegrable  rote  constraint  eq  (6) 

3  Inverse  Position  Kinematics 

The  inverse  positicn  kinematics  problem  is  to  determine  the  joint  angles  at  a  given  end-eiTector 
position  and  orientation  For  g:v«Q  end>etIector  posU^n(<t.y«)  and  orientation  0,.  the  eight  position 
constraints  outlined  m  the  last  section  are  not  enough  to  give  a  unique  solution  as  the  angular 
momentum  equation  can  not  be  used  m  the  solution  of  the  inverse  position  kinematics,  One  more 
variable,  which  we  choose  as  the  base  orientation  needs  to  be  specified  to  solve  for  the  angles 
uniquely  As  quite  evident,  any  arbitrary  value  of  0o  no*  cbosm  for  the  inverse  solution  at  a 
point  but  It  must  be  such  that  the  solution*  at  two  successive  points  satisfy  the  angular  momentum 
equation  With  this  motivation  in  mind,  tne  patn-planmng  pro^dem  has  been  broken  into  two  steps 
(a)  oDtain  the  mverse  solutions  at  a  given  using  omy  the  8  pceition  constraint  equations 

with  the  bwe  angle  ‘  'eated  as  a  free  variable,  (b)  use  an  iterative  search  procedure  to  determine 
such  that  the  jo*nt  angles  satisfy  the  difference  tbrm  of  the  angular  momenium  constraint  equation 
The  part  (a)  of  this  procedure  is  detcribed  in  this  section  while  the  part  (b)  is  described  m  Section  5 
In  this  section,  we  also  show  that  the  inverse  kinematic  solutions  of  frte-floaliag  robots  have  features 
very  different  from  those  of  the  inverse  solutions  cf  sv*.  -t.-sily  similar  fixed-base  manipulators 
On  cquai.ng  the  expressions  for  r«  -  to  from  eq  (l^  we  obtam 

ouXo  +  oiji^  +  QiaXj  +  ttuxf  +  aisxf  =  pi  (7) 

Substituting  eq  (5)  into  ^4).  wc  obtain 

i4rro-f-Sixo  +  Cix^  +  Dix^  +  +  Fuif  +  Gix^  =  0  (8) 

Oi  solving  ro  from  eq  (I j  and  subsftuting  la  the  above  equation  we  obtain 

QjiXo  +  ojjxd  *•  -f  ojixf  +  ojjxf  =  p?  (9) 

All  coefficieiiis  and  vectors  appearing  m  the  alove  three  equafons  arc  listed  m  Appendix  I 

The  eqs  (7j  and  '9)  involve  the  corfFcierits  a„  and  the  vectors  pi ,  pj  which  are  known  at  a  gi  'cn 
r.  When  resolved  along  the  eor.rdnate  d*r'ctions  of  r  *hese  two  vector  equMion?  result  in  four 
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Figure 3:  Th«inv«n«»cSutionaforan<nd«eiTectorpo«>Uo&(-l$0.~i2  0),orienUUoDU)gie^,  s  150* 
&nj  bw  angle  h  g  60*. _ 


j<al«  equariona  whieh  involve  ‘«a'  and  ‘am’  of  the  anglea  ^e,  and  A  noiaiion  aucb 

aa  u  9^  4-  scalw  equations  must  he  aimuUaneously  solved  for  the  four  joint 

angles.  On  treating  as  a  free  variable  and  using  the  procedure  described  in  Appendix  1,  the  four 
equations  can  be  reduced  to  one  8th  degree  polynomial  equation  in  the  variable  zi 

<30  +  a|Xj  +  ojxt*  +  ajii*  +  a^ti*  +  a»rj* 

+««ri*  +  <«r*i^  T  0**1*  =  0  (10) 

aB 

where  *i  =  ran(-J^), 

The  zeros  of  this  polynomial  are  the  solutions  ti  which  satisfy  equations  (7)  and  (9)  Upto  8 
roots  of  X|  (or  9Q^)  are  theoret'cally  possible  On  substituting  one  of  the  possible  eight  values  of  zj 
in  equations  (30)  and  (31),  we  obtain  two  quadratic  equations  m  Z)  These  two  quadratics  result  lo 
one  common  solution.  Bence,  a  maximum  of  8  solutions  of  (^^|,^^)  are  possible  For  each  feasible 
i^oif9§j),  there  is  a  unique  solution  for  and  9^^  from  equation  (26)  and  (27)  From  this  procedure, 
theoretically,  for  each  end'cffector  pcsition/orientatioa  and  a  specified  orientation  of  the  base  Imk, 
upto  8  solutions  of  the  joint  angles  are  possible.  The  details  of  this  algorithm  are  available  in  (6) 
Figure  3  shows  a  set  of  four  solutions  for  an  end-effector  position  and  orientation  with  the  pa¬ 
rameters  of  the  OU  free-fioating  robot  It  may  be  instructive  to  contrast  these  inverse  solutions  with 
those  of  a  structurally  similar  fixed  base  manipulator.  It  is  well  known  that  for  the  latter  case,  there 
are  four  solutions  and  the  solutions  are  two  pairs  of  imrror  images.  Fo/  the  fro-  fioating  case,  we  see 
from  the  figure  that  there  are  no  mirror  images  in  the  four  solutions 

4  Inverse  Rate  Kinematics 

Cventhough  the  focus  of  this  paper  is  to  provide  a  motion  piannmg  algorithm  using  m/erse  position 
kinematics,  it  is  important  to  develop  the  forward  and  inverse  rate  kinematics  relationships  between 
the  end-effector  and  the  joint  variables  The  inverse  rate  kinematics,  on  direct  integration,  results  in 
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acceptable  motion  plans  for  the  system  These  motton  plans  obatmed  via  direct  integration  provide 
an  easy  way  to  compare  and  evaluate  the  effectiveness  of  the  motton  planning  algorithm  using  inverse 
position  kinematics  In  this  section,  we  will  describe  the  rate  relations  in  two  steps.  (1)  the  constraints 
on  the  nine  rates  dc-scribing  the  mechanism  zo,  po,  6o,  $i,  $*,  9^,  $f,  &f,  $§  and  (2)  the  mapping 
between  the  end^effector  rates  z«,  y„  $t  and  the  joint  rates. 


4.1  Joint  Rate  Constraints 

On  diiTerentiating  the  X.  Y  position  loop  closure  equations  and  the  angle  loop  closure  equation, 
we  obtain  three  ecnstramts  on  the  nine  rate  variables.  On  collecting  the  terms  of  the  X,  Y  linear 
momentum  constraint  and  the  angular  momentum  constraint,  we  obtain  another  three  constraints 
on  these  rate  variables.  These  six  constraint  equations  can  be  written  in  a  form  Kq  =  0,  where  K  is 
a  (6  X  d)  matru: 


0 

0 

0 

Km 

Ais 

Ais 

Ait 

Ais 

Aisl 

0 

0 

0 

Kj. 

Ai5 

A,s 

An 

Am 

An 

1  j 

0 

41 

0 

0 

0 

A43 

1 

Km 

A45 

1 

0 

An 

-1 

Ais 

-1 

Ais 

(11)  s  1 

0 

As, 

As3 

Km 

Ass 

0 

A$t 

Ass 

Ass 

■  ( 

0 

0 

A« 

K« 

A,s 

0 

Asr 

Ass 

Ass 

and  the  vector  q  it  The  constants /fji,  A'ei,  and /fsj  are  * 

identically  sero.  The  remaimog  coefficients  are  listed  in  Appendix  2.  Using  the  above  matrix,  six  I 

rates  can  be  solved  m  terms  of  the  rematnug  three.  These  three  independent  rate  variables  play  the  ^ 

role  of  the  active  or  the  controlled  joints.  Defining  as  the  vector  of  the  three  active  joint  rates  and  ^ 

qr  as  the  vector  of  the  remaining  six  joint  rates,  the  equation  Kq  s  0  can  be  rewritten  as:  > 

f:,<^,  +  Kr^r=o.  (12) 

where  Kf  and  K,  are  partitions  of  K  A',  is  a  (fi  x  3)  matrix  and  Ar  is  a  (6  x  6)  matru  q;  is  a 

(3  X  1)  vector  and  qr  is  a  (6  x  1)  vector  Using  eq  (12),  q^  can  be  solved  in  terms  of  q,  | 


1 
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q,  =  -Kr'K,q, 


(13) 


If  the  elements  of  the  vector  q  are  permuted  according  to  the  choice  of  the  active  joints,  such  that 
q  =  Vq' ,  using  eq.  ( 13).  the  vector  q'  can  be  written  m  terms  of  q,  as 

q'  =  [^]=C„  (14) 

where  C  is  a  (9  x  3)  matrix  formed  by  augmentug  a  (3  x  3)  identity  matrix  £3  with  the  (6  x  3) 
matrix -Ar"*  A,  Tnis  matru  C  is 


(15) 


4.2  End'Effector  Rate  Constraints 

The  eiid'jffector  rates  z«,  y,,  and  $4  can  be  related  to  the  joint  rates  in  the  following  way.  The 
position  closure  eq  (1)  and  the  angle  closure  eq.  (2)  obtained  via  chain  A  are  diflferentiated  and 
colle.ted  These  end'elTector  rates  as  a  functioQ  of  the  joint  rates  are 

x,-rq  (1C) 


f 

I 
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I 

I 
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where  X«  =  P  is  i  (3  x  d)  matrix  The  structure  of  P  is  as  follows 

■  1  0  P,3  P,4  Pis  Pi6  0  0  0  ■ 

0  I  Pja  Pj4  Pis  Pm  0  0  0  (17) 

.00  I  1  1  1000 

The  terms  appearing  m  the  above  equation  are  defined  in  eq  (42).  Using  eq  (16)and  (14),  the 
moping  between  the  end^effector  rates  and  the  active  joint  rates  is 

X.=7q,  (18) 

where  J  =  PPC.  J  is  the  welhknown  Jacobian  mapping  between  the  end*effeeior  rates  and  the 
active  joint  rates.  In  order  to  determine  the  joint  rates  for  sperihed  end-effector  rates,  the  following 
9  hrst-order  nonlinear  differential  equations  must  be  integrated* 

q  =PCr‘X.  (19) 

For  successful  motion  planning  of  the  robot,  the  fdlowing  two  conditions  must  be  guaranteed.  J 
exists  and  is  invertible.  J  exists  only  when  the  matrix  Kr  is  invertible.  Hence,  we  will  find  the 
conditions  for  the  invertibility  of  Kf. 

4.3  Invertibility  of  Kf 

The  structure  of  the  matrix  Kr  u  dependent  on  the  choice  of  active  joints  for  the  mechanism  In 
order  to  give  a  geometric  interpretation  of  the  invertibility  of  the  matrix  Kr,  it  will  be  best  to  choose 
a  set  of  active  joints  and  partition  the  matrix  Kf.  Since  tbe  coordinates  ao>  Vo.  tmd  can  not  be 
directly  controlled,  they  are  not  good  choices  for  the  active  jomts.  For  the  sake  of  of  discussion,  we 
choose  the  active  jomt  /ector  as  q,  s  .^3  )^,  tbe  matrix  Kr  becomes: 

■  0  0  0  Kit  K,a  Ki>  ’ 

0  0  0  Kjt  Kjs 

R-  -  0  0  0  -1  -I  -1  .... 

K41  0  K43  K47  K4S  K41 

0  Ksj  Kss  Kst  K%i  K$9 

0  0  Kss  Kst  K$a 

The  above  matru  has  the  following  structure 


where  0,  Q^  R,  and  5  ate  (3  x  3)  matrices  and  all  elements  of  O  are  teros  P  is  an  upper  triangular 
matrix.  The  inverse  of  the  matru  K,  is 

From  the  above  equation,  we  see  that  the  inverse  of  Kf  exists  only  when  the  inverse  of  the  matrices 
Q  and  R  exist  Since  R  is  an  upper  triangular  matm,  tbe  determinant  of  this  matrix  is  zero  only 
when  one  of  its  three  diagonal  terms  K^\,  Kn,  K«3  are  zero  On  examining  K41  and  Ka,  we  find 
that  they  are  the  total  mass  of  the  system,  hence,  are  never  zeros  Physically,  Ko  1$  the  sum  of  the 
moments  of  inertia  and  is  also  nonzero  Hence,  the  matrix  R  is  never  singular 

The  matru  Q  is  formed  from  the  three  loop  closure  equations  These  three  equations  for  the  free* 
floating  mechanism  are  identical  to  the  position  and  angle  loop  closure  equations  of  a  structurally 


Figure  4  A  configuration  m  which  ihejomw  1. 2.  and  3  of  chain  B  are  m  a  line  At  this  configuration. 
Kf  IS  singular  ifgj*.  and  are  chosen  as  the  active  loints. 


similar  fixed«base  mechanism.  Hence,  the  configurations  where  Q  is  singular  is  tdentieaJ  to  the  singular 
configurations  of  a  structuially  similar  fixed-base  mechanism.  Ftom  the  vrork  b  literature  (e  g ,  (12)), 
the  matrix  Q  is  not  invertible  whenever  a  line  passes  through  the  three  joints  of  chain  B,  i  e..  the 
chain  B  is  fully  extended  outwards  or  is  fully  folded  inwards.  A  configuration  where  Kf  is  singular 
IS  shown  in  Figure  4.  Similarly,  it  can  be  proved  that  for  a  set  of  any  three  active  joints  among  the 
joints  of  chain  A  or  chain  B,  the  condition  of  singularity  of  the  corresponding  Kr  matrix  is  when  the 
three  unactuated  joints  are  aligned,  i  e.,  a  line  passes  through  the  three  joints 

4.4  Singularity  of  J 

The  singularities  of  the  J  matrix  have  also  been  termed  as  the  'dynamic  singularities'  in  the  literature 
(9).  Unlike  the  hr  matrix,  it  is  not  possible  to  provide  a  geometric  interpretation  of  the  configurations 
where  the  J  matrix  is  singular. 

5  Path  Planning 

One  method  to  generate  the  motion  plans  is  by  direct  integration  of  the  rale  eqs  (19)  by  choosing 
a  desired  function  X«(t)  In  general,  this  method  will  work  for  short  paths  and  will  fail  at  the 
configurations  where  Kr  or  J  become  singular. 

The  inverse  position  kinematics  algorithm  can  be  also  used  to  plan  paths  between  an  initial  and 
a  final  positwn/orientalion  of  the  end-effector  The  essence  of  the  algorithm  for  motion  planning 
paths  between  two  points  is  described  in  Table  2  A  feasible  assembly  configuration  is  assumed  at  the 
starting  point  of  the  path  The  path  is  divided  into  a  ouraber  of  btermediate  points  At  a  step  i-f  1  of 
the  algorithm,  the  current  value  of  the  base  onentation  (d®),  is  used  to  deter  'ne  the  search  interval 
for  (^o).+i-  The  search  interval  for  (do)»4.i  b  discretwed  and  correspondu  >  a  value  (ffo)i+ii  the 
inverse  kinematics  procedure  is  used  to  compute  the  joint  angles.  The  multiple  solutions  obtained  by 
the  inverse  kinematics  procedure  axe  sorted  to  determine  the  best  solution  near  to  the  joint  angles  at 
the  step  I  With  this  best  solution,  the  following  difference  form  of  the  angular  inonientum  equation 
is  evaluated. 

K«i  A  +  Kii  A  Vo  +  /f«s  A  +  K^^  A  9* 

+ K«5  A  +  /f w  A  +  /f«T  A  ?  f 


j 


Chunou  tnd-^f/taor  path 

i 

Obui»  Sun 

Ftri^  lie  auJitbtf  a/ paiiut 
{ 

Far  <#,).- ,  ■  -  *  w  (1^.  +  S 

{ 

Seht  utttnt  tiametict 
l/thtn  u  M  seLaiaM  thta 
{ 

Dattmiat  miaiintm  ttam  xotuas*  q,., 

' 

Evaluatt  aagulof  iMmtittuJrt  r|Ma»« 

Ifaapila/  memmium  hat  thofitid  Ufa  ihin 

q.,  It  iA«  appftifmat  nlatSaa 
} 

} 

} 

} 

TatU  2:  Th<  alf^onthm  to  obtioo  motioo  plm>  uamg  lavewe  kioem»t>«. 


+  (W) 

wh«r«  (h<  symbol  A  u  us«d  for  the  difference  of  &  jomt  verieble  computed  between  the  steps  1 4- 1 
and  I.  A  feasible  joint  solution  satisfies  eq.  (23)  within  a  specified  tolerance  U  is  important  to 
point  out  that  the  motion  plans  obtained  using  this  dgoiithm  are  almost  identical  to  that  obtained 
using  direct  integration  of  the  inverse  rate  kinematics  equation  (19).  Figure  6  shows  a  successful 
path  between  two  points  in  the  workspace.  The  sa.ne  path  is  also  planned  using  direct  integration 
of  the  rate  kinematics.  The  base  orientation  angle  (f^,  the  angles  0i,  9^,  and  9^  for  this  path  using 
the  direct  integration  of  the  rate  kinematics  and  the  inverse  position  kinematics  .%re  presented  in  the 
same  figure  for  easy  comparison 

U  must  be  pointed  out,  however,  that  the  use  of  the  inverse  position  kinematics  algorithm  does 
not  alleviate  the  problem  of  singularities  encountered  m  the  direct  integration  of  the  rate  kinematics 
equations.  In  fact,  one  can  demonstrate  that  the  inverse  position  kinematics  and  the  inverse  rate 
kmematics  algorithms  break  at  exactly  the  same  point  when  encountering  a  singularity  In  case  of 
ratekinematics,  due  toilhconditioningofthe  J  matrix,  the  algorithm  breaks  down.  In  case  of  inverse 
position  kinematics  algorithms,  the  search  procedure  does  not  find  a  base  angle  (^e)i4.i  close  to  (^o)i 
which  satisfies  the  difference  form  of  the  angulu  momentum  constraint  equation. 

The  inverse  position  kinematics  algorithm,  however,  can  be  easily  modified  to  avoid  singularities 
where  it  can  not  find  a  set  of  joint  angles  that  satisfy  the  difference  form  of  the  angular  momentum 
constraint  equation.  These  singularities  are  avoided  by  taking  a  deviation  in  the  Cartesian  path  in 
order  to  satisfy  the  angular  momentum  constraint  equation.  Figure  6  shows  the  joint  angles  for  a 
straight  tine  path  m  the  Cartesian  coordinates  using  the  three  algorithms  piopcsed  in  this  paper,  i  e  , 
(a)  direct  integration  of  the  rate  kmematics.  (b)  mverse  position  kinematics  without  excursions  at 
the  singularities,  and  (c)  inverse  position  kinematics  allowing  for  excursions  of  the  end*effector  point 
near  a  singularity  This  figure  shows  the  Cartesian  path,  the  base  orientation  angle,  and  the  joint 
angles  9{-  I^om  the  figure,  we  observe  that  the  integration  of  the  rate  kinematics  breaks  down 
m  the  middle  of  the  path  The  mverse  position  kinamtics  algorithm  goes  through  jumps  in  the  joint 
angli»s  at  the  positions  of  the  singularity.  The  exptended  mverse  kinematics  algorithm  which  allows 
excursions  in  the  end>effector  path  is  smooth  at  the  smgularities  and  successfully  teaches  the  goal 
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6  Conclusions 

In  this  p^«r,  we  presented  &n  &!i;omhm  for  motion>pI&Qam|'  of  free*iIoattng  robots  using  inverse 
position  kinematics  Eventhough  free-floating  manipulators  are  characterized  by  nonholonomic  con* 
straints,  we  showed  that  the  inverse  position  kinematics  coupled  with  an  iterative  search  procedure 
to  satisfy  the  nonholonomic  constraints  results  in  motion  plans  predicted  by  direct  integration  of  the 
rate  equations  The  problem  of  singularities  which  are  encountered  during  the  integration  of  the  rate 
kmematic  equations  are  stiU  faced  in  the  inverse  poMtion  kinematics  algorithm.  However,  it  is  easy 
to  take  excursions  in  the  path  using  the  inverse  position  kinematics  algorithm  to  avoid  the  suigular 
configurations  and  reach  the  goal.  The  results  obtained  using  the  inverse  kinematics  algorithm  were 
compared  with  the  direct  integration  of  the  rate  kinematics  equations  to  highlight  the  similarities  and 
differences  between  the  two  approaches  The  authors  feel  that  this  method  of  motion  planning  which 
was  applied  to  free-floatmg  manipulators  can  be  successfully  applied  to  other  classes  of  nonholonomic 
systems 
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6  Appendix  1 

8.1  Derivation  of  8th  degree  polynomial 

All  coefficients  appearing  m  this  section  are  listed  in  Section  8.2  The  equations  (7)  and  (9)  when 
resolved  along  the  coordinate  directions  of  have  the  followmg  form* 


f  OlJ  013  ]['«]  +  [  014  <»15  1  f  'fl  1  .  [  P'l.  1 

I  <>J3  ]  I  J  I  au  a„  J  I  ffi  J  “  I  Pi,  J 

[  an  a, 3  1  f  3oi  ]  ,  f  a„  a„  ]  [  3?,  ]  _  [  p'„  1 

I  a:i  a, 3  J  I  3^,  J  [  o„  q„  ]  I  .f;  J  “  I  pi,  J 


The  eqs  (24)  and  (25)  are  used  to  solve  for  the  ‘sio’  ai.d  ‘cos’  of  the  angles  0*^  in  terms  of 

joint  angles  and  0§2 


ISI 

!  _  f  +017C§2  +^13  ] 

t  021^1  +  027C§i  +  077  J 

(26) 

f  1 

f  011*01'^  017^^7'^  017  1 

(27) 

1  /fjl^0l  +  ^«*03  +  ft3  J 

The  angles  and  0^  can  be  eliminated  by  squarmg  and  adding  the  component  equations  of  (26) 
and  (27)  The  resulting  equations  have  the  following  form: 


+713301  +  7mC§  +  7l53w  +  7l«  =  0  (28) 

T3l(cfiCf,  +  S?,S?j)  +  7I2C?1 

+7»Soi  +  72eCw  +  TJS^OZ  +  72S  =  0 


(29) 


T 


I  1 


On  substitution,  cf,  Jjfp,  sf,  =  eg,  =  and  sg,  =  where  i,  =  !an(22i)  and 
1}  =  the  above  equations  ean  be  written  as  polynomials  in  xi  and  xj 

i^n*i**}*  +  t&tjxxxa*  +  t&i3*t^*i  +  t^u*i* 

+t&lSX3*  +  +  ^IJXi  +  t^isXj  +  11)19  ~  0  (30) 

^t*t**l*  +  ^2X|XJ*  +  +  tJjtXl’ 

-rt>2$*3*  +  lh<«|Xj  +  0WXj  +  i)^Xt  +  S  0  (31) 

On  collecting  the  coefficients  of  X}^,  X},  and  1,  these  two  equatons  can  be  written  in  the  following 
form: 

f  tJ-uXi^  +  t^iaXj  +  015  0l3Xi*  +  015Xi  +  014 

1  0Jt*l*  +  0n«l  +  0J5  0MX|*  +  0MXi  +  0JS 


:i’  +  0iTXi  +  0I>  1  f  1 

ft’  +  0WXi  +  0»  J  I  j  “  i  0  J 


The  set  of  the  above  two  polynomial  equations  must  be  simultaneously  solved  for  the  variables  xi 
and  X}.  The  method  of  Mialytie  elimisation*  is  adopted  to  obtain  the  solutions.  Assuming  xa  ^  0, 
the  two  equations  are  multiplied  by  xa  to  form  additional  two  equations  The  above  two  equations 
of  (32)  and  the  two  additional  equations  generated  when  by  multiplied  by  xa  can  now  be  written  m 
a  matrix  form: 

»'s  0  Xa®  0 

Jfji  *n  0  *a’  .  0 

0  xii  xia  »n  *a  “  0  ^  ' 

0  »at  »aa  *aa ,  ,  1  ,  ,0 

where  t,,  are  coefficients  of  the  matrix  in  equation  (32)  For  this  set  of  four  equations  to  have  a 
common  solution,  the  determinant  of  the  (4  x  4)  matrix  in  eq.  (33)  with  coefficients  x,;  must  vanish 
Mathematically, 


Making  these  substitutions, 


('«i*aa  -  Xia»ai)(»iJ»»  -  ^aa'is) 
-(»it»a3-»Ji»is)*-0 


xii  »aa  “■  »ia*Ji  =  ^uiixi* 


xia'wTaa'js 


xuTas-Xis»«  =  ^®3**i* 

•sO 

the  resulting  determinant  is  a  8th  degree  polynomial  m  x^  and  has  the  following  form 

Go  +  ‘*1*1  +  Ga*i*  +  GsXi®  +  GeX:'  +05*1® 

+a«ri*  +  07Xr'  +  04X1'*  =  0 


v  ■  'J.  ’*^^.“*5'^ 


8.2  Coefficients  of  the  inverse  position  kinematics 

In  equation  (8),  the  eoefhcienta  ate 


/li  =  m^+m^  +mf  +  mf  +mj 
Bi  =  /^{m|*+m^+m^)  +  /f(mf +mf) 

Cl  -  +/^(m^ +m^) 

Di  m^/^5  + 

£■1  ^ 

t\  =  mf +  mf /f 

C:  n 

The  coefficients  appearing  m  equations  (7)  and  (9)  ate' 

aa=/^-/?.  On  =  /^,  013=/^ 

au  =  *-/f.  ai5  =  -/f,  pt  =  ^?xf-/^x^ 

Qtji  =  St  -  0)2  =  Cl.  023  =  ^1 

a2i  =  fi-Ai/f,  a2$  =  Ct-4i/f 
P3  =  -^tr.  -  ^1*3  +  *3 

In  equations  (24),  and  (25),  the  .K  and  Y  components  of  P)  and  p^  are 

Pu  =  + 

Ply  -  “  ^0  )*0  +  "  ^3 

P:j  -  -/ij**  -  (St  -  v4t/f  )eo  “  Si^  +  vli/fc®3 

pjy  =  —  (Si  —  All§)S(i  -  Sj3o3  +  Ailf 

In  equation  (26)  and  (27),  the  coefficients  are 

^  >014023  +  0)3024  ,,  -0)5023  +  OjsQjs 

ft.  - - 5 - .  ft,  = - 5 - 

ft,  - - 5 - .  ft,  - - o - ^ 

023Pj, -Oi3p2»  „  -022Pir  +  0)2P2r 

ft,= - 5 - .  fe- - 5 - 

„  /  <*«Pl,  -  0)3P2,  ^  ,  -02:P),  +  0)2P2v 

ft,  = - 5 - .  ft»  - - 5 - 

where  D  =  0)2073  >  0)3022  The  coefficients  in  equatton  (28)  and  (29)  are 

Til  =  2^‘i^iJ,  Tii  =  2SiiSi3. 

Tis  =  2^^lSl3^  7i4  =  2S12S13. 

7l5  =  2S13S13',  7lS  =  Sll*  +  S12'  +  Sl3*  +  ^13^*  -  I 

72)  =  2^1^22.  732  =  SSziSlS 

723  =  ^lhl0K.  724  =  2S22S23 

725  =  *^7013  ,  720  =  ^t*  +  S22*  +  *^3*  4  -  I 
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In  equation  (30)  and  (31),  the  coefhcienta  arc 

=  7n  -  7»J  -  7m  +  7t«,  tJ'ii  =  27i3 
^14  "2715,  t>M  = -7it  -  7n  +  7m  +  7i« 
^15  =  **7m+7u-7m  +  7i«.  V’m=47ji 
=  2713,  Vm  s  2715 
VJ9  =  7u  +  7W  +  7n  +  7m 

=  7}t  ~  725  -  724  +  725,  ^  =  2723 
V’23  =  2735>  =  ~73t  •  722  +  724  +  725 

=  “721  +722  ~  724  +  72«.  =  4721 

^27  =  2723.  V2a  a  2725 
^29  =  721  +  722  +  724  +  725 
In  equation  (35).  the  coefficients  ate 


OlO 

= 

C’l5t£’2S  “ 

On 

012t^s  +  01St^S  “  -  t^2$ti’M 

012 

” 

+  i>iixl>n  -  tixxifii 

-t^22V’tS  - 

OlS 

= 

^Xlhi  +  ^I2t^3  -  -  ^>22^13 

om 

= 

The  coefficients  02,  are 

020 

s 

^U02>  - 

oti 

= 

VMtJ'29  +  -  ^I9'hf  - 

022 

^19^9  +  tf'M^T  +  tk'Ut^4  -  ^79'i'\9 
-Vto^IT  -  t^2*t^M 

023 

= 

-  ^Mths  ■■  \^17t^23 

024 

= 

V13»!74  - 

and  the  coefficients  03.  are 

030 

= 

^li'h9  ~  VioV^S 

031 

= 

^17^19  ■*■  ^19^7  -  t^l»^'r2  -  ^17t!’25 

032 

= 

V'Ut>29  i-  t/'l5t^24  +  -  ti’21^19 

-tlTS^M  -  0174^ 

031 

- 

011027^  0X2024  "  021017  —  022011 

034 

= 

V11024  “  VM021 

The  coefficients  in  equation  (36) 

are 

oo  = 

010020  -  oIq 

Oi  ^ 

OljO20  +Oio02t  -203x030 

02  =  012020  +  OiiOti  +  Oio<>2t  ”  2032030  ”  ®|i 

03  =  013020 +O12O21  +01X022 +010023 


(42) 


(43) 


(44) 


(45) 
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-2043030-2031031 

04  =  OnOjo  +  013021  +  O.jOii  +  CiiOj3  +  010024 

-2034030  -  2O31O33  —  032 
0?  =  O14O21  +  013022  +  O12O23  +  011024 

-2O31O34  —  2032033 

0<  =:  014022  +  013023  +  O12O24  —  2034033  -  033 

07  =  Oi4d23 -f  O13O24  —  2034033 

Oa  =  014024  -  O34 

9  Appendix  2 

9.1  Coefficients  of  tlie  rate  equations 

The  terms  obtained  by  diffetentiaimg  the  positioo  loop  closure  equations  are 

ifl4  =  +  ^2*011  +  ^3  ^0113 

Kii  =^2  <013  +  ^3*0133 
=  ^3*0133 

Kn  =  -If  *01  ~  ^f*fl3  -  ^3  *fl33 

=  -^f*013  “  ^3  *0133 

^f.9  =  -^3®*fm 

Kn  =  -^f  Coi  —  iiCrti  -  ^3  ^133 
^3S  =  -^3^13  “^3*013j 
A'2«  =  -^3<^13S 

^^3r  =  /fcf,+«2+^?cfm 

Coil  +  *^133 

^33  =  ^3  Coi23 

The  terms  of  the  hnerc  momentum  equations  are 

A'41  =  mo  +  mf  +  mj  +  m,  +  mf  +  mf  =  .\f 
^'43  =  Myo 

A44  =  — mf/fiSoi  —  m2(/f  Joi  +^0*013) 

/\45  =  —>^3  03*013 

A47  =  -  mf(/f3ji  +  /f2S^,,) 

3oi  +^3*013  +^3*0173) 

A'4S  =  '"1^025^2  -  me(/fsfj2  +ifSoil3) 

^A9  —  ~^e^3*0l23 

A's2  =  A/ 

^53  =  -A/lO 

/C54  =  mfOiCoi  +m3(0«‘oi  +OiCoii) 

Ajs  =  ^^Os^ois 

A'sc  =  0 

AV  =  mf +  mf  (/f  cfi  /fjcfij) 
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(46) 


(47) 


f"' 


I 


i 


+me(/fcoi  +  Cons) 

Am  =  mf +  m.(/fc«  j  +  If -»„) 

A'sj  =  W,/f  cf)}3 

The  teems  of  the  angular  irromentum  equation  are 

Am  =  /o  +  mf  if, (If  Co  +  lf,<f,)  + 

"tfnilW »«  +  'Asot)  +  + 

tttj  lfi(fo  ^  +  ^t*tf,  +  ffjCo,j)  + 

"j  l'A('o  So  +  (fsf,  +  lf,sf„)  +  If 

"■.sf  (If  «o  +  l?ef,  +  l?cf„  +  If  ef,a)  + 

"■.yf  (lo®«o  +  li®sf,  +  If  sf„  +lfsf„3)  + 

/,  +  mf  if, (If  Co  +  lf,cf,)  + 
t"?  y.V'o  So + ifisfi) + /f  + 

"f  s?l(lf  so  +  If  of,  +  lf,ef„)  + 

">1  yfi(lo  So  +  If  sf,  +  lf,sf„)  +  If 
Ku  =  mf  if,lf,ef,  +  mf  i^,lfts#,  + 

If  +  mf  afs(lfo#,  +  lf,ef„)  + 

™J»o('f»fl+lf)Sf„)  +  /,'‘ 

Am  =  mf  tf,lf,ef„  +  mf  vf,/f,sf„  +  If 
Am  =  mf  tf,lf,efi  +  mf  vf,lf,sf,  +  + 

"fsfrdfofi  +lf,cf„)  +  mfvfrdf  if,  +  lf,if„)  + 
If  +  m,if  (If  of,  +  If  cf„  +  If  cf,„)  + 
-".yf(if>f,+ifsf.,  +  ifsf,„)  +  ;. 

Ass  =  tnf  if,lf,cf„  +  mf  vfjlfjsf,,  + 

If  +  m.ifilf  oftj  +  If  of, a)  + 

"t<!/f  (If  sflj  +  If  sf,;3)  +  /, 

Am  =  m.if  If  ef,a  +  m,vf  If  if,a  +  I. 

where 

rf,  =io  +  lfoo  +  lf,cf, 

Sfi  =  yo  +  If  So  +  Ifisfi 
xfi  =  10  +  If  00  +  If  of,  +  /f,ef,r 
yf>  =  yo  +  If  So  +  If  sf,  +  Ifjsfi, 
if,  =10  + If  Co  +  If, 
yfi  =yo  +  ioio+i?isf, 

if,  =  lo  +  If  Co  +  If  cf,  +  lf,cf„ 
yf,  =  yo  +  If  So  +  If  sf,  +  Ifjsf,, 
of  =  yo  +  If  so  +  If  sf,  +  If  sf„  +  If  sf,„ 
yf  =  yo  +  'f  So  +  If  sf, + If  if„  +  If  sf„j 


The  ternw  in  eqn  (H)  ate 


=  -^5**01  “  ^2  ^01} 

As  =  "^2  *01S  *■  ^3  *0133 
As  =  “^3*0123 

As  ~  +  ^l*Coi  +  ^3  ^13  ■*■  ^3  ^0133 

As  =  ^^^1  +^3^13  +  ^3^0133 
As  =  ^3  ^12  +  ^3  ^133 

A«=/^«^»33  (51) 
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ABSTRACT  •  ITie  problem  of  the  maiupuliur  deaign  is  approached,  from  a  kuiematic  point  of  view, 
through  an  opomizaaon  fonnulaaon.  The  design  vanabies  are  discussed  including  the  location  and  the 
onentanon  of  the  robot  base  through  suitable  parameters  which  are  congnient  with  the  link  parameters  of 
the  manipulator  chai^  A  marupulator  global  length  is  defined  as  ha  objective  function,  since  it  may  also 
take  into  account  some  w<»k$pace  and  uteroal  prwemes.  Iberefne.  suitable  pioceduies  for  the 
optuntaaoon  problem  are  proposed.  Some  further  consideradons  on  optima)  design  procedures  are 
developed  by  using  an  algebme  fomuladon  for  the  manipulator  woitspace.  v/tiich  has  been  deduced  in 
previous  papers. 


1.  Introducdoii 

Tlie  problem  of  the  optimal  design  and  locatioa  of  manipuUuxs  have  been  addressed  in  the  last  decade, 
with  particular  formulations  with  respect  to  the  optimization  techniques  and  the  robot  structures. 

In  a  pioneer  paper,  the  minimization  of  manipulator  propcttons  has  been  recogmzed  and  used  to 
optimize  also  the  layout  of  a  manipulator  workstation.  (Scbeinman  ano  Ro'i .  1985). 

However,  the  manipulator  opcunal  design  has  been  recogmzed  and  stated,  basically,  with  respect  to  the 
workspace  characteiisucs.  This  ts  because  the  workspace  of  a  mampulaior  is  one  of  its  most  important 
properties  since  ti  is  related  to  the  task  area  within  which  the  robot  mampulabon  can  be  performed. 

A  fundamental  paper  on  the  topics  can  be  considered  that  one  by  Yang  D.Cii.  and  Lee  T.W .  (Yang 
and  Lee.  1984),  in  which  the  opumizMion  problem  has  been  formulated  through  a  Volume  Index  on 
workspace  and  by  usuig  succesfuUy  a  heunsoc  technique,  devek^  in  the  commumcauons  field. 

Since  the  major  complexity  and  computer  tune  consumpuoo  is  in  the  volume  calculation,  it  has  been 
thought  convenient  to  adopt  workspace  formulations  for  specific  manipulator  structures  and  to  develop  a 
stepwise  suitable  procedure,  (Tsai  and  Soni.  1983). 

Recently,  other  invesuiaiors  have  approached  the  problem  of  the  optimum  workspace  by  adapting  'ad 
hoc*  formulations  and  procedures  (ot  the  used  c^iumizauon  technique.  Thus,  the  a^bcauon  of  the  Monte 
Carlo  method  has  been  explored  to  invesagate  lU  usefulness  for  the  problems  of  lonemauc  synthesis  of 
manipulators,  (Rastegar  and  Fardanesh.  1990).  A  Sequentiai  Quadratic  Programming  Techmque  has  been 
succesfuUy  applied  to  a  specific  opumizauon  fonnuUuoti  for  the  three.revolute  mampulau^  design, 
(CeccareUi  et  1992).  A  geometnc  reasoning  has  been  also  proposed  to  deduce  opumizauon  criteria  for 
workspace  vt^ume  znd  dexterity,  which  have  been  Uien  applied  to  design  a  geometncally  opumum  su. 
revoluie  mampulaior.  (Vijaykumar  et  al..  1986).  In  addiuon.  a  specific  optunizautm  procedure  for  planar 
mampulaiors  has  been  developed  to  obtam  a  workspace  as  close  as  possiUe  to  a  prescnbed  one  by  using  a 
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suitable  descnpoon  of  the  workspace  boundary  through  a  list  of  circular  arcs  and  the  application  oi  the 
Gauss  Divergence  Theorem  for  die  area  calculkion.  (Gossebn  and  Gutilot.  1991) 

An  algebraic  approach  has  been  proved  to  be  an  ^fictent  and  versatile  tool  in  the  numenc  optimum 
workspace  design  for  three-revolute  manipulators.  (Un  and  Frtudenstetn,  19S6)  On  this  basis,  an 
alternative  algebraic  foimulauon' for  the'  workspace  boundary  of  ihree>revoliite  i.ianipulators  has  been 
developed  by  the  authtv  with  analysis  purposes  and  to  tnvesDgate  the  nng  geomeny,  (Ceccarelli.  1989) 
The  versatility  of  the  algebraic  approach  has  been  further  demonstrated  by  inverting  the  aforementioned 
formulauon  in  a  synthesis  algonthm.  (Ceccarelli.  1992).  Mmcovct.  this  algebraic  approach  has  been 
extended  to  four*revotute  manipulators.  (Ceccarelli  and  Vinciguerra.  1992).  with  the  aim  to  achieve  a 
general  algebraic  algonthm  for  workspace  determination. 

In  this  p^or.  an  attempt  is  Ulusoaied  to  formulae  the  design  problem  for  manipulaton  by  using  this 
algebraic  algorithm  for  the  workspace  determiiwion.  Particularly,  an  optinizauon  formulation  is 
proposed  whose  objective  function  is  chosen  as  a  global  length  of  manipulators  defined  through  the  link 
parameters  and  the  base  locaoon.  This  pe.’formance  index  has  been  proved  to  be  significant  on  workspace 
and  inertial  pn^rties  of  manipulators.  Funh^oe,  the  pecuUanues  of  the  proposed  fotmulauons  for  the 
optimization  problem  and  the  work^e  tteterminauon  give  the  possibility  to  design  optimum 
manipulators  by  means  of  a  search  direction  technique  and  through  a  suitable  workspace  precuion  points 
procedure. 


2.  Dcsiga  PanuBctcn  of  MaBipulators 

The  optima!  design  of  manipulator  kinemauc  chains  should  include  the  optimal  location  of  the  robot  base 
wtth  respect  to  a  fixed  ft^e.  Therefore,  the  design  parameters  can  be  considered  the  link  tune- 
independent  sizes  of  the  chain.  i.e.  for  revolute<onnected  manipulators  a^.  o,  and  d,.  isl....ji.  and  the 
vecton  b  and  which  represent  reflectively  the  position  and  the  onenuuon  of  the  robot  base  with 
respect  to  a  fixed  frame  XY2.  Fig.l. 

Since  the  mam  task  of  a  manipulator  u  recognized  in  moving  the  end-effector  and/or  a  grasped 
in  the  space,  it  Is  suitable  to  achieve  an  optimal  design  and  location  of  a  robot  taking  uito  account 
basically  wodcspace  charactensuci. 

Moiwver,  also  the  encumbrance  of  the  manipulator  is  recognized  as  an  unpoitant  issue  since  smaller 
and  faster  machmery  and  robots  are  desidereble  m  modem  industnal  applications. 

Nevertheless,  the  two  design  features  are  not  Independent  and  a  umque  meaningful  ob^&ve  funcuon 
m  the  opumuaticn  design  problem  can  be  formulated  taking  into  account  the  following  constdenuons. 

Ucan  be  thought  that  the  volume  V  of  a  manipulator  wmkspace  u  related  to  the  manipulator  length 
Lin  the  form 

V  =  clS  (1) 

where  c  is  a  function  of  the  chain  parameters:  the  mampulator  length  L  can  be  defined  as 

and  fl  IS  a  constant  coefficienL  In  fact,  it  has  been  found  that  the  workspace  of  revolute  pairs  connected 
manipulators  depends  on  lu  main  characteristics,  as  shape  and  volume,  from  the  Imk  ratios  and 
dimensions,  reflectively.  (Ceccarelli.  1989).  (Ceccarelli  and  Vmciguerra.  1^92).  Therefore,  it  can  be 
useful  to  express  the  mampulator  length  L  in  the  form 


Fig.l.  The  design  panmeten  for  kinemiuc  chain  of  a  manipulator. 


^  =  <3) 

where  k, ,  )sl,....2n4-l,  are  the  Unk  ratios  of  a,  and  d, ,  with  respect  to  a  reference  dunennon  as 

for  example  aj.  Conseguently,  the  workspace  volwne  can  he  computed  by  iniroducmg  Eq(3)  in  the 
expression  of  the  volume  of  a  solid  of  revolution  in  the  form 


V  = 


2n 

i/lfv 


L’  fr*'dz» 

»W 


(4) 


where  r*  and  z*  are  the  radial  and  axial  reaches  normaUzed  wnh  respect  to  aj  and  $W  1$  the  workspace 
boundary.  In  Eq  (4)  it  u  possible  to  recognize  a  shape  ^(or  and  a  ratio  factor  both  mnuencing  the 
workspace  shape.  represents  a  scaling  factor  giving  the  size  of  the  workspace  volume  when  the 
manipulator  dimension  is  given  through  t}  in  Eq.(3).  tne  above  expressions  it  can  be  observed  that 
the  size  and  the  shape  of  a  manipulator  woikspace  art  not  completely  independent  in  a  sense  that 
varumotis  of  hnk  dimensions  give  anse  to  different  changes  of  the  manipulator  length  and  the  wcxkspace 
volume. 

Nevertheless,  if  (he  manipulator  eiKumbrance  increases  the  workspace  volume  will  also  increase.  But 
sometimes  the  workspace  vdume  may  vanish  even  if  L.  doesn't,  since  the  workspace  nng  volume  can 
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degenerate  into  a  toroidal  surface  for  panicuiar  vtauea  of  the  link  parameters,  as  it  has  been  stressed  for 
the  workspace  nng  geometry  of  three-rcvolute  chains.  (Ceccarelii.  1989).  Funhermorc.  the  mimmum  of 
the  workspace  vt^ume  can  be  t^  null  value,  but  it  is  not  relmed  to  the  minimum  encumbrance  since  it 
depends  on  the  sue  of  the  degenmted  toroidal  surface.  In  this  last  case  the  two^revolute  mampulaior  will 
be  the  optimal  solution  since  its  toroidal  wotkspace  can  satisfy  the  same  number  of  conditions  for  the 
workspace  boundtuy  surface  as  the  case  of  three-revolute  manipulators.  (Ceccarelii.  1992).  and  probably 
It  also  occurs  in  the  case  of  n-revolute  mani^uirs 

Coaseguently,  it  (s  thought  convenient  to  avuime  as  an  objecave  function  the  "manipulator  global 
lenght*  i  which  can  be  defined  m  the  form 


(5) 

where  the  robot  base  location  has  been  included  dirough  the  b  vector  expressed  by  means  of  the  radial  aQ 
and  axial  do  components.  Fig.l. 

The  angles  and  Oq  can  be  considered  as  describing  the  onentation  of  the  mampulator  base  as 
axis  with  respect  to  Z  axis  and  with  respect  X.  re^ovely.  In  addition,  the  base  frame  can  be 
conveniently  assumed  to  be  parallel  with  the  fraire  XiY}Z|.  fixed  on  the  first  link  of  the  mampulator 
chain,  at  a  starting  motion  c^igurauon.  Therefore.  rM  dimensional  parameters  for  the  optimal  design 
pn^lem  will  also  include  the  parameters  oo*  ^  ^ 

The  proposed  formulation  for  the  objective  fonctum  can  be  thought  meaningful  also  from  a  dynamical 
viewpoint  since  the  term  (a^  ♦  dj)  can  te  considered  as  a  measure  of  inertial  characteristics  of  the  Imk. 
when  the  mass  m|  and  the  inertul  tensor  I|  of  the  link  i  can  be  computed,  respectively,  as 


m,  o  p,  S,  (a,  +  d,) 


(6) 


2dJ  -Ja.dfsa,  -Sa.djca, 

-Sa.dfsa,  2aJ+6aJd,+2d[c'a,  -2d!sa,co, 
-3a,d?ca,  -2d[sa.ca,  2aJ+6afd,+2dfs*a, 


where  p,  u  the  mass  density  and  Sj  is  the  cross-section  area. 

Therefore.  I  represents  a  performance  index  describing  syntheocally  both  kinematic  properties  and 
inertial  chaactenstics  of  a  manipulator  which  can  be  considered  as  fundamental  in  a  robot  design,  at  least 
from  a  mechanical  point  of  view. 


3.  Att  Optinizatie.'*  ronnulatioa  for  the  DesigB  Probks  of  Manipulalors 


[  By  consid^g  /  as  an  objective  function,  the  design  optimization  problem  for  manipulators  can  be 

I  formulated  in  the  form 

1 


mtnZ 


(7) 


subjeato 


J*U.J 


(8) 
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ViVo 


(9) 


where  Xj  represent  given  precision  points,  with  respect  to  the  iUed  frame,  to  be  reached  as 

workspace  points  2j«  ^  minimum  value  for  a  desiderable  workspace  volume,  and  the  design 

paiaineters  are  Oq.  a,,  a,  and  dj  with 

The  worit^iace  precision  pomts  can  be  cwidered  inside  as  well  as  on  the  boundary  of  the  workplace 
volume.  Nevertheless,  they  are  assumed,  at  most,  as  limiting  points  for  the  workspace  design  capabibty 
and.  conseguently.  it  is  usually  omvement  to  think  them  as  workspace  boundary  points.  In  this  case  it  is 
also  possiNe  to  prescnbe  wcNdcspace  charactenst^  as  voids  and  hole,  which  can  be  useful  in  practical 
a^Ucauons  as  save  regions  tor  equipment  and  personel  in  the  automaiued  enviroment  Hierefoie.  a 
workplace  descnptton  through  determination  of  tti  boundary  is  needed  and  gj  is  assumed  to  be 
determinable  from  an  analytical  expression  of  the  workspace  boundary.  Once  woikspace  boundary  points 
are  given,  the  manipulator  solution  must  satisfy  exactly  the  restricuon  with  its  workspace  bound^  and 
the  sign  equal  is  to  be  considered.  Otherwise,  a  delimitinf  region  can  be  assigned  wiihin  which  the 
workspace  may  be  outlined  and  a  weak  resiricuofl  can  bo  used  to  give  larger  design  posnbiliues. 

Tlie  constramt  on  die  workspace  vdume  can  be  of  a  determinant  significance,  sutce  this  restraint  may 
have  an  efrea  on  the  robot  sue  to  counterbalance  the  minimization  of  i  in  order  to  ensure  a  no* 
degenerated  solution  of  the  manipulator  chain. 

The  herein  formulation,  as  well  as  the  referenced  optimal  design  procedures  proposed  in  the  last 
decade,  is  referred,  properly  speaking,  to  the  dimermonal  synihesit  of  mampulator  chains  in  a  sense  that 
the  type  of  a  manipulator  structure  cannot  be  a  direct  result  of  this  optimal  design,  but  it  is  better 
considered  as  a  datum.  However,  this  usually  can  be  obtained  by  considering  the  number  of  degrees  d 
freedom  which  U  required  for  a  specific  mampulation  task.  Nevertheless,  a  certain  design  optimal 
selection  can  be  achieved  by  comparing  different  manipulator  stniclures  through  the  results  of  the  trine 
(^itunizadon  problem. 


4.  A  WortsiMce  Formulatka 

In  order  to  facilitate  the  numerical  solution  d  the  dengn  proUem  (7).  it  can  be  useful  to  express  the 
envolved  workspace  characienstics  by  me»$  of  a  proper  analytical  fMmulaiion. 

In  the  p^.  the  case  of  throe>revolute  manipulators  is  lUustnied  in  detail,  since  most  of  the  robot 
arms  show  dus  kinematic  structure  to  produce  the  gross  modon. 

The  nng  woikspace  geometry  of  x  (hiee*revolute  mampulaior  can  be  descnbed  by  considering  a 
generation  process  of  the  wcrk^e  boundary  through  a  suitable  torus  family  envelope.  Thus,  an 
algebraic  formulation  can  be  dedo^  and  expre^  through  the  radial  reach  and  the  axial  reach  of 
the  workspace  boundary  pouiis  with  respect  to  the  base  frame  in  the  form.  (CeccarelU.  1989). 


z.  =z,+d, 


(10) 


n  which  the  radial  distances  r{  and  Z|  with  respect  toZ|  are  given,  with  the  hypotheses  C}  aO  and  Ej  »0 
as 


^.^(C,z,4.D,)G, 


_  ni/l 

^1 


(H) 
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There  the  structural  coefficients  can  be  computed  as 


A|  a  aj2  4-  r2*  *  (*2  * 

Bia»4a|2r2* 

Cia2a|/$a{ 

D]  a  ■  2  a|  (22  +  <l2)  ^®l  f  *®l 

Eia*2a3(d2sa2C03  +  a2sO3)  (12) 

F|  a  4  a|*  33  (33  sa2^  563  063  +  32  S63  •  <13  sa2ca2c93) 

Gi  a2a|  33001  $03063 /sa| 

Ki  aGi^  +  EjS 

LiaFiGi 

Q,.Li2-K,(F,2  +  B,Ei2) 


and  the  reach  distances  r2  and  23  can  be  expressed  as 

f2  ■  (^*3  *  *2)^  *  *®3  ^®2  ^3  . 

23  3  d3  C03  •  33  $63  $03 


(13) 


The  angle  63  is  the  joint  angle  of  the  extreme  pair  in  the  chah  and  it  is  the  Idnematic  bme-dependeni 
variable  for  the  workspace  determination.  In  bcL  the  workspace  boundary  can  be  obtained  ftom  Eqs.(  1  !)• 
(13)  by  scanning  63  from  Oto  2)i.(CeccarelU.  1989). 

TTiis  woikspace  formulaaon  can  be  mampuiaied  with  synthesis  purposes  to  give  the  workspace 
boundary  points  through  the  position  vector  g  with  respect  to  a  fixed  frame.  (Ceccarelli.  1992). 


E|(i'i-2b'X+b-b-A,)-{C,(£,-(x-b)]+D,}G,+F,  =  0 


(14) 


•(x-b) 


K,C,  C, 


where  *  IS  the  symbol  for  the  doctpro^.gu  the  vector  of  a  workspace  boundary  point  computed  from 
the  vectorg^.  whose  components  are  riband  by  means  of  the  expression  of  reference  change  g^^P.g* 

by  using  the  rotauon  matru  R  and  the  base  position  vector  b  -  (1  represents  the  iiansposicton 

(^lerator):  13 1$  the  third  row  vector  in  R  which  gives  the  line  direction  of  Z  with  respect  tu 

Eqs.(10)«(14)  are  useful  to  express  aosdytically  the  constniot  Eqs.(8)  and  (9)  as  explicit  fi^ons  of 
the  design  parameters.  In  addition,  diese  equauons  are  useful  to  calculate  an^yhcally  the  denvaoves 
which  are  involved  in  the  numerical  optimization  process.  These  denvauves  cm  be  computed  in  a  closed' 


fOTm  as  a  funcDon  of  the  <iesign  parameters  from  Uw  ^ve  mennoned  expressions.  Fbr  example,  in  the 
case  of  the  aj  design  parameter,  the  first  denvattvescan  be  taken  the  form 


Br,  ]  _  1  9A]  22  i  (Q^tj'*~Pi)Qi'*‘^i  5E, 

3a,  2r,,  Sa,  '■’3a,  Ef  3a, 

1  r3F,  3G,/„  ^f9D,  3C,  -  3a,,Y 

2r„E,[3a,  3a, *'  '(3a,  ’'3a,  '  3a,  j 

3a,,  _  a,,3C|  -L,±Q!''3K|^  1  Q  1  3Q,  3L,  30, 'j 

3a,  °  “  C,  3a,  “  KfC,  3a,  K,C,  (  2Q,  3a,  “  3a,  “  '  3a,  j 

^  I ‘[Ml  f-L.±Q',''  F.'jaE,  -L,±q;'‘3K,  ,  i  8F,' 
3a,  °  2[3a,  ■(  E'K,  E‘j3a,  K|E,  3a,  E,  3a, 

2K,E,(3a,  2Ql'>3a,J 


whm  r| ,  and  a|  j  are  the  reach  coordinaia  o( X)j  with  reaped  lo  ihe  link  I  (nine  in  the  constreinu 
equauoiu  (8)  and  W:  u,,  v,  and  wj  are  caneaian  conponeata  o(  ai  i;  and  the  denv-jnvea  of  the  atrecnnl 
cneCflcienta  can  he  cvaluaM  by  meana  o(  the  deruunon  equauona  (12)  and  (13).  Hi;ha  dcnvauvea  can  be 
otKained  by  fiinhec  differenuaunt  the  above  eapaeaaitna  and  uaing  the  wokapace  aJgebnic  focmulanon. 

A  rtinhei  caeful  development  ot  the  alfebcaic  appiptch  concern  with  the  volume  calculation.  In  fact 
the  itng  leomeoy  o(  a  wotkapace  o(  revolute  pair  connected  manipulaton  aUowa  to  focmulate  an  efficient 
numenc  eaprcaaion  (or  voliane  evaluanon  by  ccoaidering  a  iiimted  number  o(  woikapace  boundary  poinia 
through  E<)a(l  IHI3).  Thua.  the  volume  V  can  be  calculated  by  sumrauig  up.  algebraically,  the  volumes 
of  thin  cylinders  individuated,  each  one.  by  two  boundary  pointi  n  and  n.  I  in  the  fotm.  (Ceccarelt;  and 
Vinciguena,  1992). 

in  which  r]  j,  and  i\jx  are  computed  from  E4$.(11H13)  through  an  N  point  discretization  in  63.  when 
die  proportions  are  given.  The  volume  of  voids  will  be  given  with  a  negauve  sign  so  that  it  is 

subtracted  within  Eq  (18).  when  a  suitable  choice  of  posmve  sign  in  a  listing  of  the  N  number  pouitsta 
adopted.  Moreover,  the  denvauve  of  the  workspace  volume  with  respect  to  the  design  parameters  can  be 
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computed  by  differenuatiflg  Eq  (18).  For  example,  the  denvauve  with  respect  to  aj  can  be  obtained  in  the 
fom 


tn  which  ihe  radial  and  axial  reach  denvauves  with  respect  to  a)  can  be  calculated  for  the  actual  boundary 
discretuation  tn  83.  by  using  once  more  Eqs.  (IS) and  (16). 


IVoccdurcs  (or  an  Optimal  Desitn 

Several  opumtxation  techniques  can  be  available  to  solve  the  design  optimiaauon  problem  formulated  In' 
Eqs.(7)-(8).  Nevertheless,  the  peculianues  of  the  (oimulation  and  the  proposed  algebraic  algonihm  (or  the 
deierminauon  o(  Ihe  work^e  charatiensiics  may  give  arise  to  particular  considerauons  and 
developments. 

When  Ihe  workspace  points  Xi ,  ju|,...J.  are  given  is  precision  woikspace  boundary  points,  then  the 
opnmil  design  can  be  belter  achieved  by  approaching  the  probL-m  through  a  suiuble  set  of  algebraic 
eqiunons  deduced  from  Eqs.  (ID  or  (14).  Ihis  procedure  can  be  develop  when  Ihe  precision  pomi 
requirements  are  thought  to  be  cfucial  and  of  pnoc  importance  oe  so  seven  that  the  opiimuauon  problem 
may  not  have  solution.  In  this  case.  Eqa(8)  can  be  wnttcn  as  equably  equations  aad  a  suitable  procedure 
using  Ihe  workspace  foimulslion  of  Eqs.(t4)  can  be  developed  to  solve  Ihe  design  and  location  problem  (t 
manipulaiors.  In  particular,  once  Eqatld)  are  solved  niimencally  to  |i>e  Ihe  snuctural  coefficients  and 
the  base  location  vectoa.  then  the  dimensional  paramettn  of  the  chanx  can  be  obtained  algetvaically  fiom 
Ihe  definition  Eqa(12).  ((^ccarelli.  1992).  Hence,  an  optimal  solution,  antong  aU  Ihe  obtainable  feasible 
designs,  can  be  achieved  by  choosing  that  one  which  has  the  minimum  global  length.  In  this  case,  indeed, 
the  consninl  (9)  on  the  woikspace  volume  may  not  be  satisfied,  and  particular  care  must  be  taken  on  us 
significance  and  requirement,  since  the  workspace  boundary  points  already  impose,  pracucally.  a  certain 
workspace  volume. 

When  Ihe  design  requiremenu  are  given  to  obuin  a  workapace  witiiln  a  presenbed  working  area 
through  lunualioos  on  the  reach  possibihlies,  then  a  proper  opliroiiatioo  problem  with  Eqa(7)-(9)  can  be 
sc'ved.  Eqs.(10)dl9)  can  be  again  used  mih  great  computational  effidency  in  a  suitable  procedure, 
rvtlhin  a  numerted  search  direction  opomiaaiion  technique,  foe  the  opuma!  design  of  manipulators  !ti 
Fig2  a  flowchart  foe  the  optimal  deegn  of  maiupulauts  ia  ilhistraled  by  stressing  the  importance  and  the 
usefulness  of  the  proposed  algebraic  (ormulalion  for  Ihe  rvorkspace  evaluation.  In  addition,  the  algonihm 
has  been  developed  so  that  a  oonirol  on  Ihe  iieiaiive  aolution  is  obtained  Uiroogh  suable  convergence 
paiameurs  for  the  obtained  values  of  Ihe  ob)ecove  function,  the  workspace  ptecisioo  poinu  and  the 
woikspace  volume.  By  assuming  greater  oe  smaller  values  of  these  convergence  parameters,  an  optimal 

design  can  be  adjusted  to  a  practical  design  in  a  sense  of  speeding  up  the  numencal  process  by  relaxing  or 

forcing,  respectively.  Ihe  design  requirements. 

An  example  is  ilhisoaled  in  FigJ.  The  optimiralioo  is  started  with  an  initial .....  apuUtor  whose 
worksproe  is  qute  far  to  satisfy  Ihe  design  requirements  which  are  indicaied  with  black  cucles.  In 

particular,  the  small  black  ciicles  indicale  points  to  be  crossed  oe  overpassed  by  the  woikspace  boundary 
and  Ihe  greater  Ihe  limit  of  a  presenbed  working  area  on  radial  reach.  Hie  ground  has  been  assumed  on 

zero  axial  coordinate  so  that  the  workspace  u  required  to  be  outlined  not  below  2|,  =  0.  with  a  woikspace 

volume  near  as  possible  to  KXIO  0(3.  In  llus  case,  the  robot  base  has  been  considered  given  to  stress  the 
efficiency  of  the  algebraic  formulation.  Hie  lesulu  rd  the  different  itermons  are  shown  by  a  fine  hne.  and 

the  final  resuU  by  a  heavier  line.  It  can  be  noted  that  alibough  the  siartiog  mampuUtor  woikspace  does 
nor  sansfy  anyone  of  the  design  requirements,  nevertiieless  Ihe  algonihm  teaches  a  feasible  soluuon  wiih 
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F>g^.  A  design  {^ocedure  scheme,  (hrough  an  algebmc  formubuon  of  the  woikspace  boundary,  for  I'm 
opumuauon  pioWem  ^bed  to  robooc  mampulators.  in  which  u  the  design  parameter  vector 
at  step  k:  and  tv  ^  ^  numeiMal  precision  factors  with  respect  to  the  design  indices  L  ij 

and  V:  &  and  are  the  search  direcuon  vector  and  the  scalar  step  in  an  optimization  numerical 
process 


few  iterauoRS  aR<i  it  optimizes  the  worfc^^ace  with  a  manipulator  length  of  1 1 89  aj  and  a  volume  of 
1000.34  ai.5 


Fig3.  An  eumple  of  optimal  design  evoluoon  of  three-ievolute  manipulator  workspace. 


The  proposed  algontun  can  be  extended  to  n*revolute  manipulator  chains  with  no  great  efforts  ty 
using  an  extension  of  the  fcrmulauon  of  EdS  (SHIO).  As  an  explanatory  example  can  be  illustrated  the 
case  of  four^revolute  manipchtors  by  using  the  workspace  evaluation  formulation  proposed  in  (Ceccarelli 
and  Vinciguura.  1992).  In  this  case,  in  fact,  a  generaluation  of  the  workspace  formulation  can  be 
deduced  by  considering  that  each  boundary  point  of  a  ihree-revolute  manipulator  workspace  wiU  trace  a 
torus  when  the  first  two  jouits  in  the  chains  are  rotated.  Therefore,  a  torus  faimly  can  be  obtained  bom 
all  the  points  of  the  workspace  boundary  so  that  a  suitable  envelope  algorithm  can  determuiaie  the 
woikspace  boundary  ^  fow'ievoluie  manipuiators,  (CeccartUi  and  Vinciguerra.  1992).  through  yet  the 
expnission  of  Eqs  (11).  ui  which  further  structural  coefficienis  are  considered  in  the  form 


and 


El  a  R-7 + 

F,  =  .2.,2R2 


Gt  s  •  2  at  22'  /aai 
Li»F(Gi 

K,»E,2.G,2 

Q|»L,2.K,(F,2*B,E,2) 


(20) 


„  (CjZ,+D;)(E,Gj-GjE',)+E,F,-F,E',+G.E.(C,z',  +  G,)  ^  ,  , 

Kj  =  j  ■♦■Cj 


Sj=2(z,+dj)z, 


(21) 


,  (±0.5Q'tQ;‘'=  -  U,)k,  -K',(-L,  p, 
■  C,Ki  C, 
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w  here  ri.  22  and  the  mvolvcd  coefficieru  are  now  expressed  by  means  of  Eqs  (1 1)-(13)  by  an  increase  of 
one  for  the  pedices  In  this  way.  it  is  still  possible  to  calculate  the  workspace  volume  and  its  derivative 
through  Eqs  (18)  and  (I9).  the  formulation  ^  £qs.(14)  i$  yet  descnbuig  the  workspace  boundary  points 
With  respect  to  a  fued  frame,  and  the  denvatives  of  the  posiuon  vectors  of  workspace  points  can  be 
expresse  as  the  Eqs  (15)-(17),  Therefore,  the  optimal  design  procedure  of  the  flowchart  in  Fig.2  can  be 
applied  with  small  algebraic  adjustments  only  in  the  workspace  algorithm. 


6.  Cooclusioo 

In  this  paper,  the  design  problem  of  manipulators  is  formulated  as  an  opumizauon  problem  by  usmg  a 
proper  algebraic  formulation  for  the  workspace  boundary.  This  algebrac  approach  has  been  further 
deveiqed  to  facilitate  the  numerical  solution  of  an  ^mal  design  by  proposing  suitable  procedures  and 
by  deducing  a  straightforward  algonthm  for  the  calculaticm  of  the  workspace  volume 

Furthermore,  the  position  and  the  oneniation  of  the  robot  base  with  respect  to  a  fixed  frame  have  been 
expressed  in  the  form  of  link  parameters  so  that  a  manipulator  global  length,  defined  as  a  sum  of  all  these 
dimensional  parameters,  has  been  assumed  a.s  an  objective  function.  Thus,  a  general  formulation  does  not 
differ  from  the  particular  case  with  assigned  laatum  of  the  robot  base.  In  addiuon.  the  proposed 
perforr^iance  index  is  meaningful  for  optunuautm  also  frnn  a  mechanical  point  of  view,  since  u  has  been 
shown  to  be  significant  for  both  workspace  and  inertial  properties  of  manipulator  chains 

Some  aspects  of  the  numencal  solvuig  {Rocess  are  discussed  referring  to  the  ihree-revolute 
manipulators.  Nevertheless,  the  algorithms  can  be  extended,  ui  future  developments,  to  n>revolute 
manipulator  chains  by  using  an  extension  of  the  wmkspace  formulation,  which  is  underway  at  the 
Department  of  Indusmal  Engineering  at  University  of  Cassmo.  However,  the  basic  concept  has  been 
syniheocally  illustrated  in  this  paper  by  exammuig  the  formulation  for  the  optimai  design  of  a  four* 
Rvolute  mampulatof. 


7.  Rcfereoces 

Ceccarelli  M.  (1989)  On  the  Workspace  of  3R  Robot  Arms.  Procttdin^s  of  the  Fifth  IFToMM 
Inurnattonal  Symposium  on  Theory  and  Praciicf  of  Mechanisms,  Bucharest.  1989.  Vol.U'l.  3746 
Ceccarelli  M  (1992).  A  Synthesis  Algonthm  of  Three-Revolute  Manipulators  by  means  of  the 
Workspace  Contour  Algebraic  Formulation  Proceedings  of  ihe  ASME  22nd  Biennal  Mechanisms 
Conference.  Scottsdale.  DE*VoL45. 397-403. 

Ceccarelli  M ,  and  A.  Vinaguerra  (1992)  Workspace  Evaluation  of  (general  4R  Manipulators 
Proceedings  of  3rd  Internanonal  Workshop  on  Advances  in  Robot  Kinematics.  Ferrara.  3 1 3-3 17 

Ceccarelli  M..  Mata  V ,  and  F.  Valero  (1992).  An  Opumuation  Formulation  of  7hree>Revolute 
Manipulator  Synthesis.  Proceedings  of  the  XI  AIMETA  National  Congress.  Trento,  Vol  Theory  of 
Machines,  91'^ 

Lm  C.D .  and  F  Freudenstem  (1986).  Optunuauon  of  the  Workspace  of  a  Three-Link  Turmng.pair 
Connected  Robot  Aim,  The  Mr  Jnl  of  Roboncs  Research.  r2.  IM-III 

Rastegar  J .  and  B  Fardanesh  (1990).  Geometry  Synthesis  of  Manipulators  Usmg  the  Monte  Carlo 
Method  asms  Jn!  of  Mechanical  Design.  112.450452, 

Schemman  V .  and  b,  Roth  (1985)  On  the  (^umal  Selection  and  Flacemem  of  Manipulators 
Proceedings  of  the  Fifth  ClSM’lFToMM  Sj'mposium  on  Theory  and  Practice  of  Robots  and 
Manipulators.  Kogan  Page,  London.  3945. 

Tsai  Y  C..  and  A  H.  Soni  (1985).  Workspace  Synthesis  of  3R.  4R.  5R  and  6R  Robots  IFToMM  Jnl 
Mechanism  and  Machine  Theory,  n  6. 555*563 


309 


Yang.  DCH..  and  T.W  Up  (1984)  HeunsQc  Combinatonal  Opomizauon  in  the  Design  of 
Manipulator  Workspace  IEEE  Trantacuons  on  Systems  Man  and  Cybernetics.  SMC>  14,  n  4. 571*580. 

S.  AckoowledgemcDts 

This  research  received  a  financial  suppon  from  the  NATO  ASI.  that  is  gratefully  aclcnowledged 


THEORETICAL  MODELING,  NONLLNEAR  CONTROL  AND  SENSITIVITY  ANALYSIS 
OF  A  SPATIAL  MULTI-AXIS  TEST  FACILITY  BASED  ON  COMPUTER  ALGEBRA 


K  -D  Leimbach,  H  Hahn 

Depanmcflt  of  Mechanical  Engmecnng  (FB  15) .  University  of  Kassel 
3500  Kassel.  MhnehebergstraBe  7. 

Germany 


abstract.  This  paper  presents  a  nonlinear  control  concept  of  a  spatial  mulii-axis  servo* 
hydraulic  test  facility  together  Nvtth  a  parameter  sensitivity  analysis  of  the  closed  loop  system 
Based  on  nonlinear  model  equations  including  the  servohydrauhe  actuator  dynamics  and  the  test 
table  and  payload  mechanics  a  global  nonlinec.*  diffeomorphism  is  derived  which  maps  the  model 
equations  into  nonlinear  canonical  form  Using  symbolic  languages,  a  nonlinear  control  law  is  de> 
veloped  and  calculated  based  on  exact  Imeanzatton  techniques  The  efBciency  of  this  control 
concept  with  respect  to  tracking  *nd  decoupling  behaviour  of  the  test  facility  is  demonstrated  by 
computer  simulations,  caking  into  account  variatioto  of  mechan.cal  and  hydraulic  plant 
parameters.  The  applicability  of  thts  control  approach  to  test  facilities  from  industnal  practice  is 
discussed  m  detail. 


1.  Introduction 

High  quality  mulii*axis  servonydraulic  test  facilities  are  widely  used  for  testing  of  critical 
components  of  industrial  equipment  and  of  future  spacecraft  (Hahn.  1986)  Theoretical 
investigations  of  multi  axis  test  facility  control  concepts  arc  usually  based  on  simplified  linear 
model  equations  (Hahn.  1986.  1992)  However,  the  exact  model  equations  ot  such  systems  arc 
highly  nonlinear  and  strongly  coupled  Thts  paper  provides  a  nonlinear  control  concept  lor  a 
spatial  multi*axis  servohydraulic  test  facility  (cf.  I)  based  on  exact  input  state  lineanzaiion  of  the 
control  plant  equations  (Isidon,  1989.  Slotme.  1991;  Schwarz,  1991)  Based  on  the  nonlinear 
control  plant  equations  of  Section  2  including  the  mechanical  equations  of  motion  of  the  test 
table  and  payload  and  the  servohydraulic  actuator  models,  a  nonlinear  control  concept  is 
developed  in  Section  3.  The  extreme  lengthy  analytical  expressions  occurring  in  the  design  steps 

•  test  of  exact  linearization  conditions. 

'  construction  of  a  suitable  diffeomorphism. 

•  mapping  on  the  control  plant  equations  ot  motion  to  nonlinear  normal  torm  and 

•  calculation  of  the  nonlinear  controllers 

have  been  reliably  denved  and  handled  by  systematically  using  symbolic  languages  The 
sensitivity  of  the  test  facility  behaviour  with  respect  to  cnticai  (mechanical  and  hydraulic)  plant 
parameters  is  discussed  in  Section  4  The  practical  use  oi  this  approach  for  a  coordinated  control 
of  spatial  motions  of  test  facilities  is  discussed  in  Section  5 
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2.  Nonlinear  Model  Equations  of  the  Plant  Mechanics  and  Hydraulics 
The  lest  facility  considered  includes  the  following  components  (cf.  1) 

-  a  ngid  SIX  degree  of  freedom  test  table  with  a  ngidly  attached  ngid  payload 

•  SIX  servohydrauhc  actuators  and 

•  an  integrated  control  system 


Figure  1:  Computer  drawing  cf  a  multi-axis  test  facility  driven  by  six  actuators 
2.1  TEST  TABLE  AND  PAYLOAD  MEaiANICS 
The  nonlinear  model  equations  of  the  test  facility  mechanics  are 

.V<(x, (jr,)  D,  =  P  (') 

(cf.  2)  where  M(i)  is  ihe  mema  nuiru  of  the  lest  fwiUty 

(2) 

[  [  <K>  -^th  ® 

C"  0  *.f>-*i*i»i  "»if|  -*cf  0  'Cf 

j  [o  »i  o[  c,c,  -iff.  0  } 

‘4**^  -tirrir  •(*»**>»; 

•  ycF  '  2c^r  vector  from  a  reference  point  P  to  the  center  of  gravity  C 

represented  in  local  frame  L,  m  is  the  test  facility  mass;  is  the  inenia  tensor  of  the  test  facility, 


•  «Cf  •  ®  -If#  j  ^j*i 

,“/<»  •  ‘Cf  0  j  V  *1  ■*i'«  J 
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Figure  2  MuUi'axis  test  facility  with  six  servohydraulic  actuators  (definitions  of  vectors  and 
frames) 

9.  0.  v/ are  the  Bryant  angles  (^i  asio(9).i2  asm(d).sj  »sin(v'>.c,  =co$(g»,c;  acos(^). 

C3  "CO$(v/)); 


Df;mdiagidf;i..  Jk^)  and  Ax^diagiAxi,  ,Ax6)  (2) 

are  the  diagonal  matrices  of  the  actuator  damping  coefficients  d^,  and  of  the  piston  areas 
respectively.  X]  is  the  position  and  orientation  vector  of  the  spatial  test  facility  represented  m 
inertial  frame  Ri  X2and  are  the  velocity  and  acceleration  vectors,  respectively, 

I,  .  <p  .  9  ,  V  f-  “(•<*  '•‘f  e  rK  (■») 


where  the  relation  among  variables  and  ^  .  $.  1/  is  defined  in  (14)  and  (15) 

ITie  nonlinear  vector  n(Xt.X2)  of  the  centnfugal  forces  and  of  the  gyroscopic  terms  is  defined  in 


(5). 


(  flfj 

-<!*)  h  ) 

r 

p 

mi)  ij)  ■ 

.  .  \1 

(  0  -r‘-  q'-  ] 

i -'r-'f 

~*crXcr 

0  ,  v*  1 

-4.  4  -•'i 

-After 

[-q"  0  J 

1-4. -4.  'f. 

I 

V  -tcrfff 

lit  Lt\ 

*ycf  IJ 

qcix)  IS  the  nonlinear  vector  of  gravitf,.ional  force  and  torque's 
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(0,0, -m  gf 

0  >‘C^  (  0  ' 

Z(iP  ,  0  '  ^^CP  “^2^3  *^1^3”^I^2^3  t  ■+'Cii25)  0 

~ycp  ^  4p  ’  0  J I  ^2  •  -^1^2  •  C,C2  j  V-m  g, 

and  p  =[/7i .  P: ,  pj  .  Pi .  Pj .  p^j^  e  Bt^  (7) 

IS  the  vector  of  the  actuator  pressure  differences.  Tte  nonlinear  transformation  matrices 
and  map  the  test  table  forces  and  velocities  from  joint  fixed  frames  Ki  to  test  table  degrees 
of  freedom  representation  in  frame  L  and  vice  versa,  where 


Prx 

A*'*, 

-Prx 

A*'* 

A« 

^PIP 

Prv 

A«*. 

-Pty 

A*« 

A"- 

it 

'np 

Pry 

A"*. 

-Pry 

A*” 

a"- 

^np 

Prz 

A***, 

-Prj 

A"* 

a“ 

^UP 

Pr: 

A*>*, 

-Pi: 

A«* 

a“ 

Pr: 

A‘". 

-Pr: 

A«* 

a“ 

CjCj  .  -Cjij  .  J2 

'  «i»)+jiVs' vj-w>--V2  m 

,J,Jj-C,JjC,  ,J,C,+C,JjJ,  .  C|C5, 


IS  the  onentation  matnx  of  the  test  facility  fixed  frame  L  with  respect  to  the  menial  frame  R  The 
projection  vectors  are  defined  as  Prx  »(l.0,0|.  Pry  =(0,1,0)..  Pr:  =[0,0.1]. 
rpiP  U  *  1.  .6)  1$  the  vector  from  reference  point  P  to  the  test  table  fixed  actuator  joint  Pi, 
where 

j,  ^  ~^kp  y^p 

•  'kp  ®  Zftf  0  ~^pip  >  (*“•-  -6)  (10) 

~ypiP  ^np  ® 


The  actuator  onentation  matnces  arc  descnbed  exemplary  by  matnx  associated  to  the 
x*actuator  (cf  3  and  (II)). 


cos/jcos^i  .  sinyj  . -cosy,$in/J, 

_  -siny,cos^j  .cos/i .  $iny,sinft  (11) 

sm^,  .  0  .  cos/l|  j 
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1  u>t 


inertial  fixed 
actuator  joint  Qt 


actuator  length 


body  fixed  joint  of  the  actuator  ^ 

Figure  3  Onemation  of  the  joint  fixed  frame  Kj  of  the  x*actuator 


-^1 

■jA,‘  *C,‘ 
•jA}  +  B^+C} 


S,  .>;+(c|  jj+j,  ij  cj)4|,+(c|  c,  ,  (13) 

C,  =!?+(«,  Jj-C,  Jj  f,)  xJ„+(j,-Cj+C,  Jj  J,)  )’f|,+C|  Cj 

and  rpio  =  ,  >q,{)  ,  :qio]^  is  the  vector  from  me  ongin  0  of  inertial  frame  R  to  the  ongin  Qi 

of  actuator  fixed  frame  Kj  The  transformation  of  the  position  and  orientation  vector  to  the 
velocity  vector  Xj  (corap  (4))  is  defined  by  the  relation 

(!■») 

which  includes  the  nonlinear  Poisson  equations,  where 


(ij  =ian(e)> 
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2.2  SERVOHYDRAULIC  ACTUATORS 

The  servohydraulic  actuators  are  modeled  by  the  equauons 

P~^  [Qx  P~‘^k  -*2]  ^  (16) 

where  u  is  the  vector  of  servovalve  command  inpuu 

ub[uj,  Uj,  U3,  U4.  uj.  ^  (17) 

and 

Cff  .  .  C/ft)  ,  Qp-  =  diag^Qi^i,.  <Qpi)  .  (18) 

Qt  .Q,i)  .  Kv  ^dtag{Kvi,.  ,  K^f)  (19) 

are  the  diagonal  matrices  of  the  actuator  hydraulic  wapacities.  servovalve  pressure  coefficients, 
servovalve  displacement  coefficients  and  servovalve  gam  factors,  respectively  The  servovalve 
mechanics  model  is  omined  in  this  approach 

2  J  NONLINEAR  STATE  SPACE  REPRESENTATION  OF  THE  PLANT 
The  combined  Equauons  (I)  and  (16)  may  be  written  in  nonlinear  stau  space  form 
6 

xm/{x)*B  umflx)+2bfUi  ;  xeIR"  .  ii«  J!‘  (20) 

r-* 

where 

x=  X,  .K",  6  fi"'‘  (21) 


=  e,  Ky  eK“ 


(22) 


/i  Q'  Qy  P~^  ■*: 

/=  /.  =  T(x,)xt  elR‘*  (23) 

./jJ  a{x,.xi)+p(xi)  p 

a(j:i.xj)  =  Af'(i|){-/J|(j:,)  £>,  A,(Ji)  Jij (24) 
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Cearlv,  fix)  and  B  m  (20)  are  smooth  vector  fields 


(25) 


3.  Nonlinear  Controller  Design 

In  all  known  control  theoretical  investigations  of  mum-axis  test  facilities  from  industrial  practice 
the  nonimt’ar  equations  of  motion  are  Imcanzed  locally  (compare  Skelton.  1988.  Hahn.  1986). 
The  control  concept  investigated  m  this  paper  is  based  on  exact  lineanzaiion  of  the  nonlinear 
control  plain  using  nonlinear  feedback  compensation  controllers  and  a  linear  state  feedback 
controller.  Ibe  design  steps  to  be  performed  may  be  summansed  as  follows* 

•  Test  of  exact  linearization  conditions 

•  Construction  of  a  nonlinear  state  transformation  (diffeomorphism) 

•  Mapping  of  nonlinear  control  plant  equations  into  nonlinear  normal  form 

•  Nonlinear  feedback  controller  design 

•  feedback  co.npensation  of  plant  nonlineanties  (exact  hneanzation) 

*•  pole  placement  of  the  exact  linearized  control  plant  via  linear  state  feedback 
(siabilisaiton). 

3.1  TEST  OF  EXACT  LINEARIZATION  CONDITIONS 

The  nonlinear  control  plant  (20)  is  for  rank  B]s6  according  to  a  Lemma  of  Isidon  exactly 
lineanzable  .  if  and  only  if  smooth  formal  output  functions 

y,  ,  Jij)  6  fi'  .  (i.l,  .  .6)  (26) 

exist  on  U(xo)which  satisfy  the  following  conditions  (Isidon.  1989;  Schwarz  1991.  Sloiine  1991) 

-1  L,i^fMx)~0  (27, 

for  6,  fur  k<r,^\  andforali  x  of  a  neighbourhood  U(xq)  of  Xq, 

[■4,4'-' 6  ,w.  ,4,4'-'a,w' 

•2'  £(x)a  .  .  *  IS  non-singular  at  x  *  xq  and  (28^ 

4,4‘-'6sW.  .4.2.'*-'/..(x)J 

-3  ir,=n  (29) 

l«l 

These  relations  define  the  vector  relative  degree  (q  .  /j  ,  rj.  r4 ,  q  .  )  of  the  system  (20) 

together  with  (26).  where  L*  A,(x)  are  Lie  dcnvatives  of  ^(x)  w  ch  respect  to  /  The  general 
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Matnx  T  (compare  (15))  IS  regular  for  values  of  d«/r/2+nff  (n  =  0  1.  )  The  inertia  matnx 

M(X))  IS  always  regular  (compare  (2))  The  diagonal  matrices  and  Bj  are  regular,  too.  tor  a 
test  facility  dnven  bv  six  actuators  (compare  (3)  and  (23))  Then  E(x)  is  regular  (excluding  the 
cntical  values  of  0)  if  and  only  if  IS  a  regular  matnx.  There  exist  pathological  actuator 

attachment  configurations  where  y,i(x,)  may  become  locally  singular  (compare  Figure  4) 
Those  configurations  and  isolated  locations  excluded  Ai(x,)  is  regular  and 

d«(7„(A:,))*0  (40) 

Then  E(x)  is  regular,  too.  and  the  control  plant  (20)  is  exactly  lineanzable  by  state  feedback 

3.2  CONSTRUCTION  OF  THE  NONLINEAR  STATE  TRANSFOR^UTION 

Based  on  the  previous  design  steps,  the  nonlinear  diffeomorphism  which  maps  (20)  into  nonlinear 
normal  form  is  defined  by  the  relation 


‘  p' 

’Z|' 

•*1 

where  (using  (32).  (34)  and  (35)) 


(41) 


’1 

'Oi(x)' 

jfi 

42  ' 

<(ij(x) 

8  r  xj 

rxj 

.'J. 

.<!>j(x)j 

fr  xj-^r/j 

i  r  xj+r  a(x„xj)+r«xi)  pj 

•  *  •♦(») 


and  <P  IS  a  smooth  vector  field 

Note:  (Physical  Interpretation  of  normal  form  state  vector  t) 

Taking  into  account  (!5)  the  normal  form  state  vector  €/R‘* 

has  the  following  pleasant  physical  tmerpreution: 

.  ziis  identical  to  the  test  table  position  and  onentation  vector 
yj,  Zf.  9.  e.  vf 

- 12  IS  idemical  lo  the  test  uble  velocity  and  angular  velocity  vector  jt,  •  r(a, )  i-,  and 
-  is  identical  lo  the  lesl  table  acceleralion  and  angular  acceleraubn  vector 

(compare  (41)) 

Due  to  (40)  the  smooth  inverse  vector  field  exists  and  is  desenbed  by  the  expression 


319 


regular  case  T. « 


O.O.l.y,, 

0,0,1  ,,, 


Singular  case  T. 


1.0,0  0 
0,l,0,-:,._,, 
0,1,0,-:,^ 
0,0,l,y,„ 
0,0,1, 
0,0,l,y,„  , 


singu'ar  case 


l.O.O  0  . 
0.1 
0,1,0 
0.0.1 

0.0  I.V,^ 
0.0  I 


0 


0 


0 


Figure  4  Singular  cases  of  the  mapping  values  cf  Xj 


X  = 

p 

=  0-‘(c)  = 

p-'(c,)  r‘  {c,-f  t^-T  d(.-,.cj)}l 

:i  : 

J 

3.3  DERIVATION  OF  NOR^UL  FORM  CONTROL  PLANT  EQUATIONS 
Using  the  nonlinear  coordinate  transformation  (41)  and  its  time  derivative 

z^—x 

dx 

the  nonlinear  control  plant  equations  <20)  are  mapped  to  nonlinear  normal  form 


(42) 


(43) 


(44) 

where 

r(i|)  d(x|.  jrjj+rUi)  4(x,)  p  • 


L  *  *1 

(W'(xi)  /iW+ 

^[r(x„xj>  nx,)  Xjtr(x,)  d(x|.  x:)+r(x,)  ^(x,)  ?]  /j(x)+  (XSb) 
^(r(X|,x,)  nx,)  x;+r(x,)  d(X|.  x,)]  ;,(x)j 

B,  .rc,)  Ar'(j, A.  B,  (45c) 


3.4  NONLINEAR  CONTROLLER  DESIGN 


After  having  denvcd  the  nonlinear  normal  form  control  plant  equations  the  controller  design  is 
straight  forward  and  includes  the  following  standard  design  steps  (compare  Isidon.  1989,  Sloiine, 
1991.  Schwarz  1991) 

•  feedback  compensation  of  the  plant  nonlmeaniies  (exact  linearization)  and 

•  pole  and  zero  placement  of  the  overall  control  loop  via  linear  state  feedback  (stabilisation 

and  transient  shaping) 
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Nonlinear  controller  Nonlmear  plant 


Implementation  of  a  nonlmear  feedback  control  law 

“  =  ['’  -  “(:i  -!•:))]  «  *  ‘  (■>6) 

according  to  Figure  5  yields  the  system  equations  among  input  vector  v  and  system  state  z 

Zi^Z2  .  .  ij-v-  (47) 

TTie  poles  and  xeros  of  this  (degenerate)  system  are  arbitrarily  placed  by  the  linear  state  teedback 
law  (48)  including  a  third  order  time  derivative  w,  of  the  mout  vector  w,  (for  xcro  placement  and 
transient  shaping). 

V  =  »■,  -  K  (:  -  w)  e  /f‘  (48) 

The  resulting  overall  control  (cf.  5)  system  is  represented  by  we  equations 

Zl=>Zz  .  :i=Xj  .  Xj-Wi+ZT  (x-w)ssO  {4Q) 

where 

a;,, /Cj)  ,  A:,-.-dws  (t„  .  •  *.j  • ‘.s)  ■  '  =  ' •  •  * 


and 

w  .  w^3 ,  (command  input). 
"I  =‘[4d  •  y’d  ■  4d  .<Pd-9d ,  (/jf . 

t  y^d  '  4d  •‘Pd  '^d  *  ‘Pd]  • 

«^={4d■yfd.4d•‘Pd.9d.Vdf 


:  =[zi'’ .  .  j[]'^(suie  vector) 

r,  ^{4  .  y?  .  r?  .  I?  .  9 , 0']'", 
rj  .  yj  ,  r?  .  Cl ,  8  .  erf. 

r>=[4.y*  4*  Ci.S.vrf 


(50) 
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4.  Computer  Simulatiou  Results 


The  nonlinear  control  system  of  Figure  S  with  nonlinear  control  plant  (20)  and  with  nonlinear 
controller  (46)  has  been  investigated  in  a  computer  simulation  using  standard  transient  test  signals 
w  1  for  vibration  testing  of  space  structures  (as  shown  in  Figures  6a.  7a.  8a  and  9a)  together  with 
their  first,  second  and  third  time  derivatives  as  command  input  vector  w  A  complete  and  ideal 
nonlinear  control  law  (46)  will  exactly  reproduce  those  input  signals  as  output  vector  of  the 
control  loop  In  industrial  practice  not  all  plant  panuneters  are  known  exactly  As  a  co.'sequence. 
the  plant  parameter  values  used  in  the  control  law  may  deviate  from  the  parameter  values  realised 
in  the  plant  The  influence  of  those  parametric  discrepancies  between  control  plant  and 
controllers  is  investigated  subsequently  by  compumr  simulations  Each  of  the  following  variations 
of  controller  parameters  :s  counted  with  respect  to  a  set  of  nominal  values  of  controller 
parameters  which  are  identical  to  the  plant  parameters.  Vanations  of  the  hydraulic  capacity  Ch 
which  stand  for  vanations  of  the  oil  compressibihty  due  to  temperature  vanations  and  due  to  oil 
contarrunation's  caused  by  air  bubbles  are  shown  in  Figure  6  The  tracking  behaviour  is  only 
influenced  slightly  by  vanations  of  Ch  of  SO  %  (cf.  6b  and  6c)  Unrealistic  vanations  of  Ch  by 
a  factor  four  or  more  modify  the  tracking  behaviour  significantly  according  to  Figu.t  6d  The 
coupling  of  the  mechanical  degrees  of  freedom  is  insensitive  with  respect  to  those  parameter 
vanations.  In  Figures  7b  and  7c  the  (.ommon  mass  m  of  the  test  table  and  payload  is  modified 
by  a  factor  1/2  and  2,  respectively  This  drastic  mass  vanation  again  does  not  severely  influence 
both,  the  tracking  and  the  coupling  behaviour  of  vSe  «ystem  Only  unrealistic  vanations  of  m  by 
a  factor  four  or  more  have  significant  influence  on  the  system  behaviour  (cf  7d)  Variations  of 
all  moments  and  products  o«  inertia  of  the  $;*me  order  have  no  significant  effect  on  the  s>  stem 
behaviour.  These  results  are  omitted  here.  Vanations  of  the  common  center  of  gravity  of  the  test 
facility  and  payload  are  shown  in  Figure  8.  Simultaneous  huge  modifications  of  all  components 
of  the  vector  rcp  from  reference  point  P  to  the  center  of  gravity  C  (for  fixed  P  )  by  factors 
1/2  and  2  are  shown  in  Figures  8b  and  8c.  They  don’t  affect  the  tracking  behaviour  ?nd  only 
provide  slight  couplings  among  (he  test  table  degrees  of  freedom  Only  unrealistic  vanations  of 
rcp  by  a  factor  four  or  more  show  significant  modifications  of  the  coupling  behaviour  of  the 
system  (cf.  Sd).  The  nominal  plant  model  equanons  (20)  did  not  include  nonlinear  friction  forces 
due  to  dry  faction  m  the  hydraulic  actuators  and  in  the  joints  attached  to  those.  As  a  consequence 
those  faction  forces  have  not  been  taken  into  account  in  the  nonlinear  control  >aw  design  Figure 
9  shows  simulation  results  including  nonlinear  friction  forces  of  different  absolute  values  m  the 
plant  model.  Faction  forces  Fr  smaller  than  3  KN  don't  provice  unwanted  influences  upon  the 
system  behaviour  (cf  9a)  Faction  forces  of  the  order  of  Fr  =  5  KN  don't  affect  the  tracking 
behaviour.  They  introduce  small  coupling  effects  of  some  test  facility  degrees  of  freedom  (cf 
9b)  Faction  forces  of  the  order  of  Fr  »  10  KN  introduce  slight  modifications  of  the  tracking 
behaviour  and  spontaneously  occurang  coupling  of  some  degrees  of  freedom.  Hugh  friction 
forces  of  the  order  of  Fr  s  20  KN  which  are  unreaimic  m  the  applications  considered  severely 
detenorate  both,  the  tracking  and  the  decoupling  behaviour  of  the  test  facility.  Those  extreme 
faction  forces  are  avoided  by  using  actuators  with  hydrostatic  bearings  m  the  les'  facility 
considered  The  above  numencal  sensitivity  analysis  of  the  contiol  loop  considered  demonst’ates 
that  the  exact  hneanzation  approach  is  much  less  sensitive  to  plant  parameter  ’ana.ions  and  to 
controller  parameter  variations  than  often  predicted  As  a  consequence  vr.ious  p  ocesses  and 
machines  from  industaal  practice  can  be  efficiently  controlled  by  u^ing  this  aoproac.i 


5  Discussion  of  Possible  Practical  Limitations  of  the  Control  Concept 

In  many  nonlinear  control  applications  trom  mdustnal  practice,  exact  Imeanzation  techniques  is 
of  minor  importance  due  to  the  following  limitations 

•  ( 1 )  the  theoretical  and  numerical  amount  of  work 

•  to  test  the  exact  linearization  conditions. 

-  to  calculate  both,  a  suitable  diffeomoiphtsm  and  its  inverse  and 

•  to  calculate  the  normal  form  control  plant  equations  and  the  nonlinear  controllers 
IS  extreme  cumbersome  and  expensive  and  is  often  beyond  the  limits  of  practical 
feasibility, 

-  (2)  the  plant  model  equations  are  not  accurately  known. 

•  (3)  the  plant  model  data  are  not  exactly  known. 

•  (4)  the  full  state  vector  is  not  available  for  feedback  purposes. 

<2)  the  time  derivatives  of  the  command  input  signals  are  not  available  up  to  a 
sufficiently  high  order, 

•  (6)  the  lengthy  and  complex  control  laws  cannot  implemented  as  on*lme 

algonchms. 

In  the  previously  discussed  control  of  a  spaual  multi*axis  scrvohydraulic  test  facility  these 
practical  limitations  have  been  overcome  as  follows 

•  (1)  (he  test  of  exact  linearization  conditions  and  tbe  calculation  of  a  suitable 

diffeomorphism.  of  us  extreme  lengthy  inverse,  of  the  nonlinear  normal 
fom  control  plant  representation  and  of  (he  cc.uro)ler  algorithms  have 
been  done  by  systematically  using  symbolic  languages  (some  of  these 
formal  expressions  have  typewnuen  length  of  several  thousand  DIN  A4 
pages,  compare  Table  1.  column  1). 

•  (2)  (he  plant  model  equations  (including  the  test  table  and  payload  mechanics 

and  the  actuator  hydraulics)  are  well  known  with  sufficient  accuracy. 

•  (?)  the  associated  model  dau  are  well  known  both,  from  numencal  calculations 

and  from  laboratory  expenmentst  in  addition,  simulation  results  prove  that 
the  control  concept  proposed  is  comparatively  insensitive  wnh  respect  to 
variations  of  relevant  plant  parameters  TTie  only  essential  model  data  that 
are  not  well  known  m  (he  above  application  are  dry  friction  forces  in  the 
actuators  They  may  be  drastically  reduced  or  even  avoided  by  using 
actuators  with  hydrostatic  bearings; 

<  (4)  all  18  coordinates  of  the  sute  vector  z  of  the  normal  form  control  plant 
equations  (including  test  table  posiuons  and  oneniations  and  ihe  associated 
velocities  and  accelerations)  are  available  as  sensor  outputs: 

•  (5)  the  command  inpui  vector  wj  as  well  as  us  first,  second  and  third 

denvattves  W2  ,  w^  and  are  available  as  test  signals  before  starting  a 

test  experiment. 

•  (6)  the  extreme  lengthy  and  time  consuming  control  algorithms  have  been 

drastically  reduced  by  suitable  substitutions  of  repeiiiivcly  occurring 
iniernal  expressions(coraparc  Table  1.  column  2).  they  can  be 
implemented  as  real  time  aigonihms  in  transputers  or  signal  processors 
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number  or  pages  or 
symbobc  expression 

number  of  pages  ot 
implemented  expression 

a 

9614 

43 

p 

1630 

63 

<D"* 

1570 

55 

Table  !.  Leogth  of  symbolic  expressions  and  implemented  algorithms  of  the  nonlinear 
control  laws  (counted  in  typewritten  DIN  A4  pages)  computed  by  using  the 
symbolic  language  MACSYMA 
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Figure  6  Time  histones  of  the  test  table  degrees  of  freedom  obtained  from  computer  simulations 
including  parameter  variations  of  the  actuator  hydraulic  capacities 

(a)  Nominal  value  of  Cj| 

(b)  Vanation  of  Cjj  by  a  factor  of  0  5 

(c)  Vanation  of  Cjj  1/  a  factor  of  2  0 

(d)  Vanation  of  Cu  by  a  factor  of  4  0 


Figure  8  Time  histones  of  ihe  test  ubie  degrees  of  freedom  obiamcd  from  computer  simulations 
including  parameter  variations  of  the  common  center  of  gravit)' 

(a)  Nominal  value  of  r^p 

(b)  Vanation  of  r^p  by  a  factor  of  05 

(c)  Vanation  of  r^^p  by  a  factor  of  2  0 

(d)  Vanation  of  r^p  by  a  factor  of  4  0 


Figure  9  Time  histones  of  the  test  table  degrees  of  freedom  obtained  from  computer  simulations 
including  dry  fnction  forces  wubin  the  servohydraulic  actuators  and  the  joints 

(a)  Actuators  and  joints  without  fnction 

(b)  Fnction  force  of  Fj^  »  5  KN 

(c)  Fnction  force  of  =  10  KN 

(d)  Unrealistic  high  faction  force  of  Fj^  ~  20  KN 
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ABSTRACT 

V\c  object  of  this  paper  is  to  present  new  results  about  the  modelling  and  idennEcaaon  of 
Hexible  robots,  the  existence  of  a  minimum  ret  of  parameters  is  proved  by  the  use  of  a 
symbolic  method.  The  detenninaaon  of  this  minimum  set  increases  the  robustness  of  the 
identification  process. 

The  identiiicaaon  model  based  on  the  energy  theorem  is  shown  to  be  Imear  in  terms  of  a 
set  of  physical  parameters  called  standard  parameters.  A  necessary  and  su^icient  condition 
which  ensures  the  minimality  of  the  standard  parameters  is  given.  This  condiuon  depends 
on  eigen  functions  if  the  model  derives  from  an  assumed  modes  method  and  on  shape 
functions  if  the  model  denves  from  a  fimte  elements  method. 

In  the  case  of  robots  whose  links  are  all  flexible,  we  demonstrate  that  the  only  possible 
regroupings  of  parameters  are  obtained  with  parameters  belongmg  to  the  same 


1.  Introduction 

The  active  control  of  robot  flexibilities  requires  considerable  effort  m  terms  of 
modelling  and  identtficadon.  Compared  with  ngid  robots,  the  degree  of  difficulty  m  thr 
case  of  flexible  robots  is  inaeased  because  of  the  existence  of  non  linear  interacuons 
between  the  large  ngid  displacements  and  flexible  components  of  the  elastic  deformations. 
We  can  find  in  [1]  (2]  a  summary  of  different  methods  The  mam  diflerences  are : 

•  the  choice  of  parameters  •  in  particular,  the  choice  of  reference  frames  for  the 
desenption  of  elastic  displacements-, 

•  the  choice  of  the  approximaaon  of  the  deflection  -  the  most  common  approximate 
desenpaon  are  bas^  on  assumed  modes  method  or  finite  elements  method-, 

-  the  phyrical  principle  used  to  obtain  the  dynamic  model  -  virtual  work  pnnciple  or 
Lagrange's  equations 

-  the  way  these  equanons  are  calculated  -the  use  of  a  symbokc  or  a  numerical  method-, 

-  the  degree  of  approximation  -developtneiit  order  of  the  model,  order  of  magmtude  of 
the  elastic  displacements,...-. 


The  control  of  such  structures  has  been  extensively  studied.  The  mam  approaches  are  :■ 
methods  of  non  excitmg  trajectones  (3).  adaptaave  control  [4],  control  usmg  a  knowledge 
model.  In  this  last  case,  we  can  fmd  singular  perturbation  methods  [5],  LQR  methods 
based  cm  an  approximated  imeanzed  model  (6]  or  non  Imear  decouplmg  methods  [7], 

Our  present  work  is  based  on  the  Imowledge  model  approach.  We  have  noticed  m 
previous  works  [8, 9]  that  control  laws  are  prone  to  errors  i^e  m  the  evaluation  of  the 
parameters  which  describe  the  model.  It  is  therefore  necessary  to  find  a  compromise 
between  the  complexity  of  the  model  and  its  time  computation.  A  first  stage  consists  m  a 
structural  reduction  of  the  model  -the  choice  of  the  number  of  finite  elements  or  eigen 
functions  describing  the  flexibilities  of  the  robot  determines  its  dynamical  performances 
A  second  stage  allows  us  to  fmd  the  be»  parameters  •  and  to  identify  them  •  in  order  to 
:^}proximate  &e  real  behaviour  of  the  rolxx  -  even  if  the  chosen  model  is  not  accurate  •  and 
to  make  its  computation  possible. 

The  identification  of  the  parameters  of  rigid  robots  has  been  studied  m  [10 . 14)  On 

the  one  hand,  idendficadon  ensures  the  on-lme  determiiiation  of  the  parameters  of  the  robot 
for  control  purpose.  On  the  other  hand,  the  determinauon  uf  the  set  of  minimum 
parameters  of  robots  reduces  the  computauona!  cost  of  dynamic  model  and  increases  the 
robustness  of  the  idenoficaaon  process. 

In  the  case  of  flexible  robots,  several  identification  schemes  have  been  studied.  Some 
on'Une  identification  schemes  are  based  on  mput-output  ARMA  representations  (15, 16, 
17].  Another  approach  consists  m  elaboratmg  a  mmimaJ  idenniicadon  model  based  on  a 
knowledge  .'uodel  of  the  robot  and  in  applying  a  least>squaies  method  There  are  two  bnds 
of  minimal  identification  model :  the  first  consists  in  applying  the  theorem  of  energy  for  the 
robot,  the  second  comes  hrom  the  dynamic  model.  More  details  on  these  two  models 
applied  in  the  case  of  one  or  two  link>planar  robots  can  be  found  in  [IS]  and  [19].  A  set  of 
standanl  parameters  has  been  proposed.  Its  tmnunaii^  has  been  demonstrate  using  a 
numencal  rank  analysis  of  the  observation  matiix  which  is  constructed  with  a  random 
sequence  of  points. 

In  this  paper  we  offer  a  new  direct  formal  analysis  of  the  minimality  of  the  standard 
parameters.  The  paper  is  organized  as  follows  :• 

•  The  first  part  d^ls  with  the  modelling  of  the  flexible  robots  and  the  detenninauon  of  a 
standard  set  cf  parameters  The  idenoficaDon  model  is  deduced  from  a  physical 
equating  cf  the  theorem  of  energy.  We  demonstrate  that  the  idenuiicaQon  model  can  be 
wntter.  m  a  linear  form  with  res{^  to  the  standard  set  of  parameters. 

•  A  second  part  is  devoted  to  the  problem  of  the  minimality  of  the  standard  set  of 
parameters.  Wc  give  a  necessary  and  sufficient  condition  which  is  related  to  the  choice 
of  the  eigen  (or  ^ape)  fiincoon*  cf  die  discrettzauon. 


2.  Modelling  Of  Flexible  Robots 

We  study  thereafter  a  single  chain  open-loop  robot  structure.  The  elastic  deformauons  of 
each  link  wi^  respect  to  its  rigid  configuratitm  are  supposed  to  be  small. 

The  elastic  motions  of  each  Imk  are  referred  to  the  position  of  the  undeformed 
corresponding  link. 

2.1.  DESCRUTION  OF  THE  ROBOT 

The  different  (tames  used  to  define  the  model  of  the  flexible  robot  are  desenbed  on 
figure  1. 
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•  IS  the  ngid  coniiguraQon  of  link  i, 

-  Q  is  the  defonned  configuraaon  of  Ur^  i. 

•  Li^i  IS  the  center  of  the  joint  between  link  i  and  link  I't*!, 

•  Ri  B  (L,»X|,Y|,Z0  is  a  f^e  attached  to  link  C„ 

•  Rl/?i  a(Li+i»Xi,Y,^  IS  a  frame,  parallel  to  frame  R|  and  centred  on  Lt+i, 

.  .  .  (0) 

•  RLi-fi  ~(L|4.},  X|,Yi,Zi4.t)  IS  a  transformed  frame  from  RLi^-i  after  the  elasuc 
defonnauon  of 

•  R|4.i  a(Li4.|,X|4.t.Y|^i,Zi+i)  is  a  transformed  frame  from  RLi^t  in  the 
transformation  funcaon  of  the  joint  variable  qrji+i. 


•  frgum  1:  Detinidon  of  link  fram^ 

2.2.  TRANSFORMATION  MATRICES 

All  the  transfonnaQons  are  represented  with  the  homogeneous  transfoimanon  matnces 
The  global  transfonnacion  matrix  from  R]  to  Rh.i  is  deftned  as  follows: 

‘^TRi+i=R,TRSli  E(Li+l)  RL,.iTr,+i  (1) 

where 

'  is  a  given  constnni  transfomudon  from  R|  to  :  translanon  of  vector 

r  .<•' 

L|L|.i. 

(0) 

-  E(Lin) «  is  the  elasnc  transfontunon  mattu  from  RL,*i  to  RLi.i-  Its 

components  are  a  fuwmon  of  the  elasnc  displncemert  end  iDQDon  of  Lt.i  of  Q.i  with 

respect  to  its  ngid  configuration  1^|. 

•  is  the  transfomunon  matru  from  RLi.i  to  Ri.|.  It's  a  funcaon  of  the 

rigid  jouil  variable  qRi.i. 

2.3.  DEFINrnONOFTOEELAS'nCDEFORMA'nONS 

We  now  consider  that  each  linl:  is  modeliaed  with  a  deformable  beam.  Moreover,  we 
suppose  that  the  elastic  displacement  field  of  each  beam  verifies  Euler-Bemoulli's 
hj^thesis. 
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Let  M  be  a  point  of  the  cross-secaon  of  the  beam  which  is  perpendicular  to  the  neutral 
axis.  Let  P  be  the  pomt  of  the  neutral  axis  which  mtersects  the  same  cross  section  -Figure 
2.  The  position  of  any  point  M  ■  belonging  to  link  C,  -  with  respect  to  frame  R|  is  obtained 
by  superposmg  the  elastic  displacement  due  to  the  link  flexibility  (Ue(M))  to  the  ngid 

posmon  of  M  tied  to  SJ  (Ur(M)). 


RiLiM  «  R'Ur(M)  +  R'Ue(M) 
where : 

•  RiUr(M)  »  (x,  y.  ajT 

•  RlUtfM)  »  *‘0,(P)  +  XiPM 

-  RiPM  » JO,  y,  z|T 


(2) 

(3) 


The  elastic  displxement  vector  of  the  neutral  axis.  J^'UtJPlT.^'OeJPlTjT,  can  be 
defined  with  respect  to  the  tnodri  or  nodal  coordinates  depending  on  the  disctenzation  :> 
expansion  or  fimte  elements  method. 

If  a  modal  expansion  method  is  used,  the  expression  of  the  elasdc  displacement  vector  of 
the  neutral  axis  is  given  as  follows ; 


R>U.{P) 


1”1 


(4) 


L  "'e.CP) 

wiih : 

<hj(x) » '’8'"  f™™ons 


If  a  finite  element  method  is  used,  the  expression  of  the  elastic  disiilactment  vectOT  of  the 
neutral  axis  is  given  as  follows: 


R'U.C?)  ■ 

R<8e(P)  . 


Ni(xl.*'U,i 


(5) 


i 
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where  :• 

-  ^iU«i  IS  the  (12x1)  vector  of  nodal  coordinates : 

R'U.i  =  tux[,  uyj . 6zj,ux^,ayJ,  .  SzjF 

-  N'(x)  IS  the  (6x12)  shape  funenons  matrix. 

In  this  case,  we  can  also  wnre  the  elastic  displuemem  vector  of  the  neutral  axis  as 
follows  :• 


m, 

=  5;  N'(x)R'Ue.O) 

J’l 


L  ®'e,(P) 

with  t 

-  mj  B  12,  for  IB  1 . n 

-  N'(x)  B  (Nl(x),  NJfx).  .. .  N,y 
■  n;(x) 


(6) 


(N,- (X) . N^,(x)lT 

n  allows  us  to  deal  wii 


deal  with  the  finite  elements  model  as  well  as  with  the  modal 


This  new  form 
expansion  model 

Now,  we  adopt  the  general  formulacon : 

R.U,(P)  “i 

»  y  <I>  (x)  q‘(t)  =  <t>Kx)qci(t)  (7) 

R'9,(P)  J  jti  - 

where 

qa(t)  is  the  vector  of  modal  or  mxial  coordinates, 

<I>,(x)  is  a  matnx  (6  x  m,). 

R’u,(P)'^  b  b(u1(x),  u  j(x),  uj(x)) 

R.9,(P)’^  B  aiT  =[ei{x).  9i(x),  ejfx)) 

u|(x),  uj,(x)  uj(x),  0j(x),  9J(x)  and  0J(x)  are  the  elastic  displacements  and 
roianons  at  abscissa  x  along  the  beam. 


U>  ■ 

■  ^(x) 

=  ^(*)qei(0”  j 

S'  . 

f<tiKx), 

<tei(0 


(8) 


where  the  left  superscripts  • "  * "  and  "  r "  •  are  relative  to  the  translation  and  rotation  terms 
of  the  elastic  displacements. 

■tbifx)  is  a  (3xini)  matnx,  m;  is  the  number  of  elasdc  degrees  of  freedom  of  Unit  t ; 


L 
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■  ®;(x)  ■ 

■  <I>i‘i(x) 

‘*’lm<*>  ' 

VDKx)  = 

*^(x) 

= 

<t>2lW  •• 

..  ^2>) 

-  ?3<*>  - 

..  «>3mW- 

The  Euler-Bemoulli  hypothesis  allows  us  to  wnte  that  8J(x)  =  •uj(x)^  and 
0  J(x)  =  uJ(x)j[.  Thus  we  can  wnte  which  is  a  (3xnii)  mamx  as  ;■ 


■*  4i(x)  ■ 

*4(x) 

‘l>4l(x) 

Wfx)  = 

?5<*) 

= 

■®ix(x) 

= 

■*3‘l.x(*)  . 

-'J>3iu.x(x) 

-  ?6(*)  - 

-  ?ix(x)  . 

-  ®21.xW  .. 

I’tLi.xW  - 

2,4.  GEOMETRICAL  AND  KINEMATIC  MODELS 


The  position  in  Ro  of  any  point  M  of  Q  is  given  by  the  following  expression  • 

r  fhJOM  1  „  r  R'L,M  1 

[  I  1  J 

wiA: 

\-\ 

■‘'“TRi” 

’  ^  homogeneous  cransformason  mamx  from  Rj  to 

1716  kuieauQc  model  is  derived  from  the  geomemcal  model  by  differennatmg  equanon 

(U). 

r  1  „  r  R'L,m  *1  r  RiL,M  1 

^  J  =  dR0TR,.|^  ^  J^-R0Tr,.<|  j  j  (12) 

The  calculation  of  d*'')TR,is  performed  by  using  the  differenual  homogeneous 
transformanons.  The  general  expression  of  d’hiTRi  is  given  ui  12). 


3.  Energy  Expression  And  Identidcatlon  Model 

3.1.  LINEARIZED  MODEL  WITH  RESPECT  TO  INERTIAL  AND  STIFFNESS 
PARAMETERS 
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In  this  section,  we  de&ie  the  pnysical  panniers  which  appear  m  the  calculation  of  kmenc 
and  potential  energies  of  Q.  These  parameten  define  the  standard  set  of  parameters  of  C(. 
Equations  (2),  (3)  and  (7)  lead  to : 


mi  m| 

*  *  X  ‘Ue(»  +X  ^  y) 

j=l  j=l 

mt  mi 

R'L,M  =  I  y  +  ^  <t>^i2(x)  qje(t)  -  ^  <t>ji,(x)  z  qje(t) 

j=l  j=I 

"’i  oi| 

*  +  X  ■  X  y  IjeW 

J=1  pi 

The  contnbudon  of  C|  in  the  total  kinetic  energy  of  the  robot  is  defined  as 


(13) 


Eci  =  4  J  (Roo‘M)-dm 

■‘linSi 


where 


(14) 


The  expanding  of  eq(14)  using  expressions  (12)  and  (!3)  leads  to  a  linear  cxpressio.i 
wiih  respect  to  die  following  parametere  of  link  i: 


^  J  p  1 2  dm.  .  I P 1  P2  * jltfx)  Oi,(x)  dm,  |  p  i  <Pjl^(x) 

f  '‘™-  J  P I  P2«jl(x)  ®^,(x) 

link  i  link  i 


dm 


)  dm 


with 

-(Pl.p2)  <  {x.  y.  z)  X  (x.  y.  r) 

•  k  s  1,  6 ;  I «  1. ....  6 :  j  «  1. .  mi ;  p»  1. ....  mi 


In  order  to  reduce  the  large  number  of  parameters,  we  take  into  account  a  few 
hypotheses  about  the  stu^>e  of  the  links.  Hius,  if  the  liolu  are  modeled  as  homogeneous 
and  uniform  beams  of  constant  and  symmetnc  cross  secuon,  the  integral  on  link  i  becomes 
a  product  of  an  integral  on  the  section  and  of  an  integral  along  the  length  of  link  t 


J  P 1  P2<I>jlc(*)  ‘tpV*)  <>n>  =Pi  f  Aft)  d*  JP 1  P2  dS 

link  i  x'*, 


(15) 
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If  the  length  of  the  link  is  defined,  the  integrals  of  the  fiincncns  <l>jic  or  of  other  fimcnonals 
of  these  functions  (product,  space  derivative,...)  are  known. 

The  only  unknown  p  -ameteTS  are  those  which  depend  on  the  integral  on  the  section  •  they 
arc  defined  by:  Jpi  ,52  dS 

Finally,  r‘'e  only  unknown  parameters  are  :• 

PiSi.pi  Ixi.pl  lyi  Cl  Pi  Izi  (16-a5 

with 

•  Pi  IS  the  volumic  mass  of  link  i, 

-  Si  IS  the  secaon  of  link  i, 

•  Ixi.  lyi  and  Iq  are  the  quadratic  momenta  of  the  sccnon. 

From  the  same  hypotheses,  it  appean  that  the  total  potennal  energy  -  sum  of  potenoai  and 
gravitational  energies  *  depends  linearly  on  the  foUowmg  paiameters  ‘ 

PiSi,  EtS|.G|Ixi,EiIyiand£iIa  (16-b) 

where 

•  El  IS  the  Young's  modulus  of  link  i, 

•  Oi  IS  the  transverse  modulus  of  link  i. 

Wc  take  into  accoun*  p,  concentrated  masses  which  are  distnbuted  along  the  neutral  axis  of 
the  ^am  •  figure  3«  Therefore,  wc  introduce  pi  additional  parameters  which  are  the 
CLUses  tner  of  these  elements. 


me 

ri 


1 


•  figure  3  •  concenorated  masses 

Finally,  the  standard  set  of  parameters  of  a  n^Unks  robots  is : 

X=[XlT . X'T . XnT|T  (17) 

whw 

•  XMs  a  ((8  4-  pi)  X  1)  vector  of  link  i  parameters 

X*  a  { piSi,  pilxi.  pilyi,  pilri,  EiSi,  Gilxi.  Eilyi,  Eila,  mcil . mcipj^ 

•  mcij  is  the  concentrated  mass  on  the  knk  Q  at  the  absassa  xcij 

•  pi  1$  the  total  number  of  concentrated  masses  along  link  Ci. 

3.2.  ENERGY  IDENTmCA-nON  MODEL 

In  oeda  to  identify  the  inemal  and  stiffiiess  parameters  of  the  robot,  one  can  use  either  a 
dynamic  model  or  an  energy  model.  We  suggest  using  the  energy  model  m  order  to  study 
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the  minimality  of  the  standard  set  of  parameters  because  of  the  following  advantages  it 
uses  scalar  functions  instead  of  the  vector  funcuons  of  the  dynamic  model  and  it  avoids 
accelerations  calculation  (18). 


The  energy  model  is  obtained  from  the  total  energy  vananon  principle : 
t2 

HCn)  -  H(t2)  =  AH  (q.  q)=  JrT  q  dt 
ti 

where ; 

•  H  a  E  +  U  is  the  total  energy  of  the  structure 

•  E  is  the  kineac  energy 

-  U  IS  the  total  potential  energy.  U  »  Ed  Ep 

•  ^  IS  the  elastic  potential  energy. 

-  Ep  IS  the  graviiy  poienoal  energy. 


(19) 


'  q  IS  the  tune  denvauve  of  q, 

■  q  =  [Qi . **nl*^*^  vcctorof  the  degrees  of  freedom  of  the  smicturc 

■  qi  =  ( qRi.  qJ,F . 

•  qRi  IS  the  joint  vanabte  of  link  i. 

•  qei  IS  the  (mi)x  I  vector  of  the  elasuc  degrees  of  freedom  (modal  or  nodal  coordinates) 
of  link  i, 

n 


•  nti- 


mi,  IS  the  number  of  clastic  degrees  of  freedom. 


•  r  is  the  vector  of  torques  of  the  actuated  joints 

It  IS  easy  to  verify  that  eq(l9)  can  be  rewnoen  linearly  with  respect  to  X . 

n 

AH(q.q)  =  = 

isl 

where 

•  Ah'  =  h'di)  •  h'(t2) 

-  h'  (0=  ( hj(l) . hj^p,(0 1  is  Uiecoefficieniof  X*  m  H. 


fn 


q  dt 


(20) 


4 .  Minimum  Parameters 


A  classical  identification  method  consists  in  a  sampling  of  the  linear  model  defined  by 
eq(20)  at  different  times  (ti « 1.  c).  Wc  obtain  an  overdeterrmned  system : 

Y  =  W.X  +b  (21) 

where 


Y  IS  the  (e  x  1)  measurements  vector ;  u  corresponds  to  different  values  of 
dt  at  different  instants  t|  and  t2. 
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n 

•  W  IS  the  (e  X  ^  8+p, )  obscivation  matnx  which  is  rciated  to  ihc  corresponding 

1*1 

values  of  Ah*, 

•  b  13  ihe(e  x  1)  errors  vector. 

Th f  minimality  of  X  is  proved  by  calculatmg  the  rank  of  W :  If  W  is  a  full  rank  matrw.  X 

A 

IS  minimal  and  the  least  square  soluQon  X  is  analyucally  given  as  the  single  solution  of  the 
normal  equations  * 

(WnvlX=WTx 

In  order  to  ensure  the  robustness  of  tlus  idenufi^on  process,  we  suggest  to  studv  the 
formal  independence  of  the  functions  Ah*.  In  the  case  of  flexible  't.actures,  wit  e 
secnon  2  hypotheses,  we  offer  condiuons  for  regroupmgs  which  depend  on  the  eigen 
functions  (or  shape  functions). 

4.1.  FUNCTIONAL  INDEPENDENCE 


The  expression  (20)  defined  on  a  vector  space  E  of  functions  AhJ,  -  from  R2{n+nci)  on 
R**.  Thus  we  can  formulate  the  search  of  a  ounimal  set  of  parameters  as  the  family  of 
funcnons  (Ahj)  independence  analysis . 

In  fact,  if  one  can  find  a  linear  combination  such  as  :■ 

^  8+pr 

ihl-i  laiAhJ  wtth(r.k)!'(i.))andaE  eR  (22) 

J  r=l  k«l 

with  constant,  the  energy  model  is  equivalent  to  the  new  model  obtained  by  ehminatmg 

Xj  and  by  replacing  the  X  J  by  X  J  X-. 

Let  ai  be  a  ( (8+pi)xl)  vector : 

ai  =  t“i . “s+pil"^ 

A  necessary  and  sufEciem  condiaon  forlhefanuly  (Ahj)  to  be  independent  is ; 

Va'eRS+P'wnhVietl.nl. 

n 

Ta'Ah‘*0  oVieO.n),  a*»0  (23) 


where 

•  n  is  the  number  of  links  of  the  structure, 

•  8-f  pi  IS  the  dimension  of  the  standard  parameters  vector  of  link  t, 

•  pi  is  the  number  of  concentrated  masses. 

If  the  condiuon  (23)  is  not  verified,  the  family  (Ahj)  is  linked  and  some  Imear 
combinauons  exist  between  the  Ahj.  Some  regroupings  between  parameters  Xj  arc 
possible. 


340 


Remarks! 

1 }  The  functional  independence  must  be  vcnfled  for  eveiy  couple  (q,  q) . 

2)  The  condiQon  (23)  can  be  rewnnen  with  hj.  Hence,  we  obtain  ‘ 
n 

^  a»  h'  +  C  *  0  (V  ( q,  q))  »  a*  =  0 .  i  =1.  n  (24) 

1*1 

n 

where  C  is  a  constant  with  respect  to  (q,  q ).  C  *  2  h*  for  t » t\ 

1*1 

4.2.  CONDITIONS  OF  REGROUPING.  CASE  OF  a  SINGLE  LINK. 


In  what  follows,  we  present  the  regrouping  conditions  of  parameters  of  a  link  with 
parameten  of  the  same  link. 

The  hincnonal  independence  of  { AhJ)  does  not  depend  on  the  values  of  q  and  q  Thus,  u 
has  to  be  venfied  for  any  set  of  couples  (q.  q ).  It  has  to  be  verified  particularly  with  q^  « 


qi(  *  0  for  k*l...  i«l  and  qa:  *  qRi  =  0.  If  the  moDon  of  the  link  i  is  only  paramemzed 
with  tts  elasac  displacements,  its  kineac  and  potential  energies  are  given  by  the  following 
expressions : 

li 


2Eci»  Jlpi  Si  +pi  Ixi  e{2(x)  *pi  lyi  6p(x)+  pi  Ij,  eJ2(x))  dx  (25-a) 


li 

2  Ed,=^J  (E,  lyi  ,j(x)+Ei  la  0p.x(x)+E,  Si uj2,x(x)  +  G,  Ixi  e'l^.xlx)  )dx  (25-b) 
Epi"  Jpi  S,  U''‘'(x)  gdx  (25-c) 


where 

•  index  I  is  the  orientation  of  beam  neutral  axis,  indexes  2  and  3  are  the  base  vectors  of 
the  cross  secaoo. 

-  g  is  the  gravity  vector. 

Stmi^y  the  kineac  energy  of  one  concentrated  mass  mcr  at  abscissa  xcir  ts  given  as : 

Ecoicir  “  j  nicir  u*^(xcir)  (26) 

arid  Its  gravity  potential  energy  as : 

Epcocir  *nicir  u^(*cir)  S  (27) 

From  equations  (18),  (25),  (26)  and  (27),  wc  can  extract  the  8  +  pi  coefficients  hj  of  the 
standard  parameters : 
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h 

It 

hpiSi=  l(U‘’*’(x)g  +  il'^(x))dx  (28-a) 

hpilxi  =  Jepfxidx  (28-b) 

h 

0 

it 

hpilyi  =  0i2(x)dx 

(28-c) 

hpila*  Joplxldx  (28-d) 

li 

h 

hEUyi=  J  x(x)dx 

(28-e) 

hEtl2i  =  J  052  x(x)dx  (28-0 

h 

u 

h 

hGirxi  =  J  61^,  x(x)  dx) 

(28-g) 

hEiSi  =  Jul^,  x(x)  dx  (28-h) 

hmcir  u^'^(xcir)  8  u^^(xcir) 

r=l...p, 

(28-1) 

4  2,1.  ExprasionOfThehj  as  a  Function  Of  ^(x) 

Now.  by  using  expressions  (8),  (9),  (10)  and  (28).  ii  is  possible  to  wnie  the  (8  +  pi)  com¬ 
ponents  hi  of  the  standaid  panimetcis  with  respect  to  the  coefficients  <^(x)  • 
li 

hpiSi  =  J  (qie’''  ‘^‘'^(x)  g  +  qte'*'  '$‘^(x)  ^(x)  qie)  dx 

■■  qie^  GpiSi  +  qie^  ApiSi  qie  (29-a) 

It 

hpilxt  =  J  q  le^  ®4^(x)  Ojfx)  qie  dx  =  qie^  Apiixi  qie  (29-b) 

li 

hptlyi  =  J  q  le’^  ®3.x^<x)  93.x(x)  qie  dx  =  qieT  Ap jy,  qie  (29-c) 

li 

hpUzi  •  J  q  te'''  *ix<x)  qte  dx  =  qie'*'  Apja  qie  (29-d) 

li 

hEiIyi  =  J  qie’*'  *3  Jtx^(x)  *3ptx(x)  qie  dx  =  qie'*'  KEUyi  qie  (29-e) 

li 

hEilzi  =  J  ric'^  fixxM  flic  dx  =  q,c'^  KeiIzi  qic  (29-f) 
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I 

I  hEiSi  =  J  qie’^*j,x'^(x)®'ljt(*)qie<lx  =  qie'‘'KEiSi  qie  (i9-h) 

hmcir  =  2  qic*^  )  qic  qic"^  8 

I  =  qie^  Gmcir  +  qie^  Anjcir  qie  r=l,..  p,  (29-i) 

I  With : 

li 

ApiSi  =  J  [  ^.i'''(x)  $;(x)  +  4jT(x)  ^‘(x)  +  ^*T(x)  i‘(x)  1  dx 
li  U 

'  Apilxi”  J  Apay,=  J  £L3,x^(x)  i3,xW  <** 

li 

■  Apaa=  J  4.2.x'^(*)  Sfe2,xW  <lx 

Amor"  !fei^(*cir) 4i(xcir)  +  i2^(xcir) ■'■  43^(*cir) It^ixcir)  f=  >.•■  Pi 

'  li  li 

KeiSi”  Js6.1.x^(x)il,x(x)dx:-  KEiIyi  =  J  i.J.xx'^Wi^.xxWdx 

'  li  li 

KEjIzi-  j  KcUxi-  J  ^,x’’'(x)44.xW  dx 

li 

GpiSi  “  J  'i'(xcir)^g  dx;  Gmcir  “ '4‘(xcir)^ 8  r=  !.•  Pi 

The  dimensions  of  the  matnces  Aa,  Kk  and  Gg  are  respectively  (mi  x  mi),  (mi  x  mO  and 
(mi  X  1). 

<  We  note  that  the  link  i  total  energy  H'  can  be  wntten  as ; 

H| »  qie^  A'  qie  +  qie^  K*  qie  +  qie^  G* 
where 

-  Al  is  a  constant  matrix  ; 

A*  =  ApiSi  piSi  +  ApUxi  pilxi  +  ApUyi  pilyi  +  ApUa  Pild  +  ^Amcir  nkir 

r=l 

•  Kl  is  a  constant  matrix  : 

K* «  KgiSi  EiSi  +  KEilyi  Eilyi  +  KEiIa  Ella  KGiIxi  Gila 


t 


r=l 


4  2  2.  Regrouping  Conditions 

If  a  linear  combinanon  exists  between  the  functions  of  energy  h*  of  the  link  i.  it  can  be 
wntten  as  follows  •• 
fl*  h*  +  C  =  0 

Rewritten  with  respect  to  the  matnces  A^.  Kk  and  Gg.  this  expression  leads  to  a  linear 
combmatioa  between  these  matnces : 

<lic^{«piSi  ApiSi+  opilxi  Apilxi+  ctpilyi  Apilyi+  opja  Apjzi+  S^Omcir  Amcirl  Qic 

+  qie^  (ctEiSi  ^EiSi  ■*■  otEilyi  ^Eilyi  +  otEiIn  KEila  +  OGilxi  KCiIxi  J  Qic 
^  Pi 

+  qicT  {apiSi  GpiSi  +  £  Omcir  Gmcir }  ^  ^  (30) 

r»l 

However,  by  defimaon,  the  modal  or  nodal  coordinates  ‘qie*  and  their  time  denvaoves  • 
ic-  arc  independent.  Hence,  cq(30)  leads  to  the  foUowmg  linear  system  of  equations : 

Pi 

opiSi  ApiSi+  ctpilxi  Apilxi+  opUyi  Apilyi+  opilia  Apiin'*’  ^^Orocir  Amcir  “  0 
Pi 

OpiSi  GpiSi  +  £  ctrocir  Gmcir  ®  0 
r»l 

OEiSi  KEiSi  +  OEiIyi  KEJyi  +  aEila  KEiIzi  +  oCiIxi  Kcilxi  =  0  (3!) 

*  * 

To  each  symemc  matrix  A,  and  Kt  can  be  associated  a  vector  Aj  and  K^,  obtained  by 

* 

ordering  one  by  one  and  in  a  predefined  order  the  components  of  Aa  in  A^^  and  the 

« 

components  of  Kk  in  . 

The  dimension  of  the  A^  and  matrices  is  '2 —  ^  D- 
Finally,  we  obtain  the  following  system  of  equations : 


I 


0 

A  *  - 
''me 

.  ^pilxi 

K  ^  - 
*'nud“ 

.  •^EiSi 

“me  = 

-C  - 

0 


Eilyi 


GpiSi  Gmal  GnKi2 

*  *  * 

A. 


pila  ''piSi 

^Eila  ’^Gilxi  J 


=  ( Opilxi :  apilyi ;  “pilzil  “piSi  F 
Ogij  =  (Omcil :  “inn2 .  •  • ;  <^mcipi]^ 
fi^d  =  (OEiSi ;  aEayi ,  «Eazi ;  otGOxi  F 


Gmapi 

* 

'^mapi  . 


From  «)(32),  we  can  fonnulaie  two  theorems : 

Theorem  1 . 

If  the  rank  •  c-  of  the  mamx  D'  is  equal  to  (8+pt).  thete  is  no  legtoupmg.  Therefore, 
there  are  (8+pi)  tninioial  parameteis. 

Demonarapaa: 

With  this  conoition,  the  matnx  of  the  system  descnbed  by  eq(32)  is  a  full  rank 
matru:  and  the  stngle  solution  of  this  system  is  the  null  vector.  There  is  no  Imear 
combinason  between  link's  parameteis  and  no  regioupmgs. 

TllWBin22 

If  the  tank  -  c-  of  the  matrix  D*  is  lower  than  (Sa-pi),  there  aie  some  linear  combinanons 
between  the  functions  hj  which  lead  to  (8  +  pi  -  e)  legroupmgs 
Demonstration : 

c  IS  lower  than  (8  +  pi)  i  c  is  the  tnaximun  number  of  lines  or  columns  of  D'  which 
are  mdependent.  The  dimension  of  the  vector  space  E  is  c.  We  ran  build  a  base  of 
this  space  with  the  c  in^pendent  columns. 

If  there  ate  some  regroupings,  the  minimum  set  of  parameters  becomes  XR;.  Its 
dimenston  is  c.  XRi  is  obtained  by  selecting  the  pnncipal  parameters  which  fit  with  the 
minor  of  maximal  rank  extracted  from  D*. 

Remarks : 

-  As  one  can  notice  that  matrix  D'  is  a  bloc  diagonal  matnx  -  see  eq(32)  the 
condinon  of  tegroupmg  which  depends  on  the  rank  of  D*.  leads  to  the  two  following 
conditions  t 

iank(Aj^j)  =  4  +  pi  el  rank(K,^d)  ” 

-  mi  IS  the  number  of  elastic  degrees  of  freedom 

•  rank(Aiie)  =  4  +  pi  4  +p, 
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*'  r^k(Kj3id)  *  4  ■ 


mi  (di  +1) 


v4. 


m,43 


If  mj  =3  and  pi>5,  wc  are  sure  that  a  regrouping  exists : 
mi  (mj  +3)  „  ,  , 

- 2 - ~  ^  4nd  4  +p,  >  9 


If  there  are  some  regroupings,  we  only  keep  fiincuons  which  are  independent  and  not 
equal  to  zero.  If  Ahj^  =  0,  H  docs  not  depend  on  X^.  Now  we  suppose  that  the  modal  {or 

shape)  functions  are  chosen  in  order  to  prevent  the  possibility  for  any  dhj^  (i=l..  ,n  ; 
k=i . 8+pi)  to  be  equal  to  zero. 

4.3  CONDITTONS  OF  REGROUPING.  CASE  OF  N  LINKS. 


We  suppose  that  all  the  possible  rtgroupmgs  desenbed  before  have  been  done.  They  lead 
to  the  independence  of  the  energy  factions  for  each  link. 

In  this  section  we  demonstrate  that  there  is  no  regroupmg  of  a  parameter  of  one  link  with 
some  parameters  of  another  link.  The  demenstrapon  is  based  on  a  recurrence  from  link  n 
to  link  1.  We  have ; 

n  n-l 

2 11*  Ah'  »  0  e»  o'*  Ah'*  +  a>  Ah'  «  0  (33) 

1=1  i»I 

Expression  (33)  must  be  venTied  for  any  value  of  (q,  q).  One  can  choose  two  mstants  t| 
and  t2  such  as ; 

(qRiCl)  =  qRi(t2)  and  qR,(tl)  =  qR,{t2) 

(34) 

Reidl)  =  qeiCz)  and  qei(ti)  »  qeittz) 

With  this  couple  (q.  q),  we  can  nonce  that 
V  i  a  1,  n  -1  Ah'  =  0 

because  the  components  of  h'  depend  only  on  the  components  of  the  vectors  qj  et  qj  (j  = 
1 ,  i).  In  fact,  the  total  eneigy  H'  of  the  link  is  a  function  of  the  standard  parameters  vector  ■ 
X'  -  and  of  the  components  of  qj  and  qj  (j  =  I,  i). 

Thus,  expression  (33)  and  condinons  (34)  lead  to : 


a"  Ah"  =  0  (35) 

First  It  appears  that  there  is  no  possible  regrouping  of  parameters  of  the  link  n  with  the 
antecedent  links  parameters. 

Moreover,  we  have  a"  =  0  thanks  to  the  results  of  sccnon  4.2. 

So,  there  is  no  linear  combination  between  the  parameters  of  the  link  n  and  the  parameters 
of  the  other  links.  The  only  possible  regroupmgs  of  parameters  of  link  n  arc  regroupings 
of  parameters  of  this  link  with  some  parameters  of  the  same  link. 


}4« 


In  the  same  way,  we  demonstrate  by  recurrence  (Ic  =  n-1  to  k  =  1)  that  for  the  whole 
structure  the  only  possible  regroupings  are  regroupmgs  of  parameters  of  one  link  between 
them. 


5.  Conclusion 

We  have  just  shown  that  it  is  possible  to  study  the  minimality  of  the  dynarmc  parameters  of 
a  flexible  robot. 

The  approach  we  have  chosen  is  general  and  symbolic.  This  approach  can  be  applied  to 
any  t>^  of  robot  It  is  symbolic  because  u  is  not  necessary  to  simulate  a  random  najectory 
in  Older  to  find  a  sequence  of  points.  Our  approach  is  based  on  an  analysis  of  the 
independence  of  the  energy  funcnons. 

Finally  we  have  presented  a  method  which  leads  to  a  necessary  and  sufficient  condidon 
(theorem  1)  which  ensures  the  minimally  of  the  set  of  standard  parameters  of  a  flexible 
robot.  These  condiuons  depend  on  eigen  functions  if  the  model  comes  out  ffom  an 
assumed  modes  method  and  on  shape  functions  if  the  model  comes  out  from  flnite 
elements  method. 

Especially  the  dimension  of  the  minimal  set  of  parameters  is  bnked  to  the  number  of  modes 
usra  to  descnbe  links'  flexibilities. 

Lasdy.  m  the  case  of  robots  whose  links  are  all  flexible,  we  prove  that  the  only  possible 
regroupings  of  parameters  are  provided  with  parameters  belongmg  to  the  same  link. 
Funher  developments  of  this  research  deal  with  the  idendficancn  process.  Results  have 
been  obtauied  previously  on  a  two  flexible  links  planar  robot  The  idennflcation  is  in 
progress  m  the  case  of  a  three  bnks  anthropomotphic  robot 
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SAFETY  AND  SURVIVABILITY  ANALYSIS  OF  WALL-CLIMBING  ROBOT 
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ABSTILACT'  In  this  paper,  an  explanation  of  the  need  for  the  climbing  robot  is  given 
first.  Second,  a  safety  analysis  is  performed  to  illustrate  how  the  robot  is  guarded 
against  falling.  This  safety  analysis  is  used  to  determine  the  design  forces  required  on 
the  suction  cups  that  hold  tlie  robot  in  place.  Finally,  a  survivability  analysis  was  done 
to  show  that  the  robot  can  withstand  a  drop  from  a  height  of  1  3  meters  if  it  were  to  fall 
If  the  robot  does  fall,  it  would  be  desirable  to  minimize  the  amount  of  damage  on  the 
equipment  mounted  on  th'.  robot.  The  method  presented  m  this  paper  proposes  to  swing 
the  arms  of  the  robot  into  the  direction  of  the  impact,  using  them  to  absorb  the  majoniy 
of  the  impact  energy.  For  analysis  of  the  fall  protection  system,  a  mulubody  model  was 
developed  to  simulate  its  dynamics  during  a  fall. 


1.  Introduction 

Robot  manipulators  are  well  suited  for  structured  environments  and  are  currently  being 
used  for  most  modem  manufactunng  opetauons.  Researchers  are  continually  looking  to 
expand  the  application  of  robots  in  other  areas.  Ordinary  robouc  manipulators  used  in 
normal  indusmal  applicanons  are  not  suitable  for  unstructured  environments  such  as 
nuclear  power  plants,  chemical  plants,  tall  buildings,  bndges,  ships,  and  aircraft.  Robots 
needed  for  unstructured  environments  must  be  mobile,  intelligent,  and  be  able  to  perform 
tasks  that  are  dangerous,  difficult,  and  tedious  for  human  operators  However,  these 
mobile  robots  have  some  limitations  To  extend  the  capabilities  of  these  robots,  a 
relatively  new  and  exciting  idea  for  climbing  robot  is  being  developed.  This  climbing 
robot  can  move  on  all  surfaces  —  walls,  ceilings,  and  floor.  Since  climbing  robots  have 
the  capability  to  move  around  freely,  they  have  the  most  potential  for  use  in  unstructured 
environments,  performing  tasks  such  as  cleaning  of  a  tall  building  or  repainng  a  ship. 

Mobile  robots  can  replace  humans  or  reduce  the  exposure  of  humans  in  hazardous 
environments.  They  can  also  relieve  workers  from  repetitive  work.  Research  on  mobile 
robots  and  legged  locomotion  has  been  pursued  for  many  years,  and  there  have  been 
many  excellent  contributions  made  in  these  areas.  Hcmami  [1]  considered  the  stability 
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of  a  mobile  robot  on  rough  terrain.  Waldron  (2]  studied  the  kinematic  analysis  of  the 
legged  robots  and  developed  an  algorithm  of  motion  planning  for  a  six  legged  robot. 
Messun  ct  al.  (3]  discussed  two  types  of  walking  mechanisms,  one  with  control  of  multi- 
joini  legs  and  the  other  with  decoupled  degrees  of  freedom.  He  showed  that  multi-jornt 
legs  would  be  able  to  negcuate  rough  terrain  better  than  the  machines  that  walk  with  the 
fixed  pattern  Song  [4]  described  an  efficient  analytical  approach  for  gait  study  and  an 
application  for  sequencing  and  placing  the  legs.  McGhee  (5).  Isik  (6)  and  Crowley  (7] 
investigated  computer  control  of  legged  robots  on  vanous  terrains.  However,  the  mobile 
robots  used  in  the  above  studies  do  not  have  the  reach  capability  that  one  may  require 
in  an  unstructured  environment  Due  to  the  deficiencies  of  these  mobile  robots,  there 
IS  a  need  for  another  class  of  robotic  systems  such  as  a  climbing  robot.  Climbing  robots 
can  be  designed  to  move  or  climb  on  almost  any  surface  that  is  honzontal.  inclined, 
vertical,  and  even  upside-down  on  a  ceiling. 

Robots  that  can  attach  to  and  climb  on  many  structure  surfaces  are  just  beginning 
to  emerge.  Research  on  mobile  chmbmg  robots  for  inspection  and  maintenance  is  being 
pursued  in  Japan  [8,  9,  10,  1 11,  France  (121,  Russia  (131,  and  recently  m  the  U.S.  [14. 
15.  16}  A  wall-climbing  robot  built  by  Hirosc  (8)  uses  magnets  which  allow  the  robot 
to  move  on  the  steel  walls  of  steam  boilers  in  nuclear  power  plants  or  ships  Akir.  et 
al.  (9,  10,  11]  designed  and  demonstrated  several  climbing  robot,  one  of  which  could 
climb  a  verucal  wall  of  a  building  using  a  turbo  type  fan  system  to  create  adhesion  and 
dnving  forces. 

The  climbing  robot  presented  in  this  paper  is  a  succession  of  the  ROSTAM 
(Robotics  System  for  Total  Aircraft  Maintenance),  which  was  devised  at  Wichita  State 
University  (14,  15,  161,  Rs  predecessors  include  ROSTAM  I,  a  four-legged  robot  with 
suction  cups  on  each  of  the  legs  as  shown  in  Figure  1.  This  robot  can  move  m  two 
directions  perpendicular  to  each  other  or  diagonally  in  a  senes  of  steps  in  either 
perpendicular  directions.  This  robot  can  also  travel  on  a  slightly  curved  surface. 
ROSTAM  II.  a  two-legged  robot  shown  m  Figure  2,  can  also  travel  on  a  curved  surface, 
but  It  can  only  move  in  one  direction.  The  advantage  of  ROSTAM  II  is  that  ns  lighter 
weight.  The  next  generation  ROSTAM  III,  shown  m  Figure  3.  has  a  central  rotation 
system  for  changing  the  moving  direction  to  any  desired  angle  All  three  of  these  robotic 
systems  use  suction  cups  for  adhesion.  The  suction  cups  were  adopted,  since  they  can 
adhere  to  many  more  matenal  types  than  the  magnetic  method. 

The  safely  analysis  is  performed  so  that  the  robot  docs  not  fall.  However,  if  it 
were  to  fall,  the  simulation  results  arc  presented  through  animation  and  graphical 
representations.  There  arc  many  animation  programs  m  today’s  software  market,  such 
as  Autodesk  animator  pro  (17],  which  uses  a  movie  method,  but  this  kind  of  animator 
IS  not  suitable  for  mechanical  system  animation  For  mechanical  system  animation,  a 
physics-based  animation  needed  to  be  developed.  Thus  an  animaiion/simulation  system 
based  program  was  developed  (18,  19}  Using  AutoCAD,  the  geometry  of  a  complex 
mechanical  system  can  be  easily  modeled  and  modified  using  the  graphics  database 
interface.  A  new  graphics  database  can  be  produced  for  each  animation  frame  by 
processing  geometnc  information  from  a  graphical  database  and  simulation  results. 
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Figure  2  ROSTAM  II,  the  two  legged  robot 
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Figure  3  ROSTAM  III.  I'ao  legged  roooi  with  roiauonal  center 


2.  Robot’s  movement  commands  and  specincations 

As  shown  in  Figure  3,  there  are  two  suction  cups  allocated  on  each  side  of  the 
robot’s  two  legs,  and  there  are  four  suction  cups  m  the  center  ponion  ot  the  robot  The 
suction  vacuum  generators  arc  connected  to  each  suction  cups  for  salcty  reasons  Two 
air  cylinders  comprise  the  legs  which  arc  used  for  creating  motion  of  the  rooot  The 
rotation  of  the  robot  is  with  respect  to  its  base  in  the  moving  direction  This  motion  is 
generated  by  a  DC  motor  through  a  pair  oi  worm  gear  systems  The  central  portion  of 
the  robot  sucks  to  the  surface  while  the  two  legs  rotate  about  it  to  a  desired  circc  ’lo 
The  suction  cups  on  two  legs  can  work  either  synchronously  (both  legs  are  sticking  or 
moving),  or  asvnchronously  (one  leg  is  sucking  to  hold  the  robot  and  the  other  leg  h 
making  a  forward  movement,  and  then  aitacning  us  suction  cups  on  the  suriace  to  hold 


3.  Safety  Analysis  of  the  Robot  i 

The  most  important  consideration  in  designing  the  climbing  robot  is  to  ensure  that  it  is 
secured  firmly  on  the  surface  while  climbing  There  are  two  dangerous  circumstances  | 

that  could  occ  ir  when  the  robot  is  climbing  on  a  surface.  One  is  slipping  and  the  other  ^ 

IS  falling  In  general,  the  robot  can  be  modeled  for  the  safety  analysis  while  climbing  i 

an  inclined  surface  as  shown  in  Figures  4  and  5  In  Figures  4  and  5.  0  represents  the 
inclined  angle,  and  a  stands  for  the  moving  direction  When  0  equals  90“,  it  means  the 
robot  IS  moving  on  the  vertical  plane,  and  when  0  equals  180°,  it  means  the  robot  is  on  , 

the  ceiling,  ' 

The  tipping  moment  which  would  cause  the  robot  to  fall  can  be  expressed  in  xyz  ,! 

coordinate  system  as: 

M,  ■  m  g  h  sinO  »  cose  ( 1 ) 


My  •  Ma  sina  ( 2  ) 

Where 

m  IS  mass  of  the  robot; 

Mj  IS  the  dynamic  moment  caused  by  the  impact  of  the  cylinder,, 
g  gravitational  acceleration, 
h  height  of  the  mass  center  of  the  robot. 

The  equivalent  total  upping  moment  and  its  directional  angle  ^un  be  obtained  as. 


P  •  tan-‘(  My  /  M.)  W 

Using  the  above  equivalent  total  upping  moment,  the  cquihbnum  equation  will  be  created 
so  that,  except  along  the  line  with  8  degree,  there  is  no  active  morreni. 

As  It  IS  observed  from  Figure  4,  the  highest  point  on  the  suction  cups  (the  point 
with  maximum  y'  coordinate  in  x'y'a'  system)  has  the  most  and  earliest  tendency  to  leave 
the  surface,  and  the  lowest  point  (the  point  with  the  least  y'  coordinate  m  x'y'z'  system) 
has  the  least.  Therefore,  it  is  reasonable  to  assume  that  the  reaction  force  acting  on  the 
suction  cups  has  linear  distnbution  along  y'  axis  shovm  in  Figure  4.  Based  on  this 
assumption,  the  reacuon  force  density  (f')  on  every  point  of  the  suction  cups  can  be 
expressed  as  a  linear  function  of  ns  y'  coordinate  in  x'y'z'  coordmate  system  and  the 
amount  of  the  reaction  force  density  at  extreme  points  A,  and  B  or’ 


4' 
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the  robot)  The  detailed  working  procedure  for  synchronous  operation  is  espiained  as 
toliowing' 

(1)  Initialization  consists  of  all  the  suction  cups  sticking,  one  leg  is  in  a  retract 
position,  and  the  other  in  extended  position,  as  shown  in  Figure  3. 

(2)  If  more  steps  are  required  continue,  otherwise  stop  the  movement. 

(3)  Check  the  vacuum  on  the  central  suction  cups  If  vacuum  is  not  good  stop, 
otherwise  continue 

(4)  Release  the  suction  on  the  legs. 

(5)  Move  the  legs  away  from  the  surface  for  a  predetermined  amount  of  time 

(6)  If  desired,  rotate  the  legs  tn  a  new  direction 

(7)  Extend  one  leg  and  retract  the  other  leg 

(8)  Start  the  vacuum  on  the  legs 

(9)  Move  the  legs  so  that  they  touch  the  surface 

(10)  Check  the  amount  of  vacuum  on  the  legs  suction  cups,  if  vacuum  is  not 
good  stop,  otherwise  continue. 

(11)  Release  the  vacuum  on  the  central  suction  cups. 

( 1 2)  Extend  one  leg  and  retract  the  other  one  At  this  time,  the  central  ponion 
of  the  robot  will  move  one  step. 

(13)  Start  the  vacuum  on  the  central  suction  cups 

(14)  Go  to  step  2, 

The  voltage  used  for  DC  motors  and  solenoid  valves  is  24  volts  The  diameter 
of  each  suction  cup  is  1 1  4  cm.  The  suction  cups  can  create  34  5  kg  force  under  18  Hg 
vacuum  according  to  the  component  catalog  (20)  More  specifications  of  the  robot  arc 
given  in  the  table  1. 


Table  1  Specifications  of  the  robot. 


Robot  parts 

Weiqht  (kq) 

Length  (aa)oHeight  from  surface  (cin)i 

Central  body  | 

8.5 

20  1  14  1 

Left  leg 

1.0 

5  i  8  i 

Right  leg 

l.O 

6  1  8  1 

The  reaction  force  acting  on  a  sucuon  cup  "i"  can  therefore  be  wniten  as' 


'5b-  y')  <iy' 


(6) 


The  moment  of  each  sucuon  cup  contnbuted  by  the  rcacuon  force  can  be  expressed  as 


0) 


Where  x',„  and  y'„  axe  the  x  and  y  coordinates  of  the  center  of  the  suction  cup  "i”  in 
x'y'a'  coordinate  system;  and  d  is  the  diameter  of  the  suction  cup. 

The  force  and  moment  equilibrium  equations  are  derived  as. 


EFy„'  -  £M^-Mcos(a.p)  .  0 

1-1  1-1 

(8) 

X  '  -  M  sm(B*P)  •  r> 

(9) 

M 

• 

m  g  cosO  ♦nF*J^f,  *0 

(10) 

1*1 


Where 

F  is  the  suction  force  produced  by  a  single  suction  cup; 

y'„  IS  the  y  coordinate  of  the  center  of  sucuon  cup  "i"  in  x'y'a', 

f,  IS  the  perpendicular  reacuon  force  acung  on  sucuon  cup  'i'; 

M  IS  the  moment  causing  the  robot  to  fall,  which  was  expressed  in  equauon  (3). 
n  IS  the  number  of  sucUon  cups  holding  the  robot. 

When  robot  is  in  safe  condiuon,  the  perpendicular  reacuon  force  which  is  acung  on  everv 
pomt  of  the  edge  of  the  sucuon  cups  should  be  greater  than  aero.  The  cnucal  case 
occurs  when  these  reacuon  forces  become  aero;  for  example  when  q,,  becomes  equal  to 
aero.  This  means  there  is  no  contact  between  the  sucuon  cup  edge  and  the  surface,  and 
the  -uot  will  fall.  The  result  of  the  safety  analysis  is  shown  in  the  Figure  6  The  most 
dangerous  condiuon  for  this  robot  is  when  it  is  climbuig  and  inchned  surface  with  the 
angle  of  about  130  degrees,  and  moving  in  a  43  degrees  direcuon  as  can  be  seen  in  the 
Figure  6. 
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Figure  6  Safety  analysis  results 
4,  Survivability  Aiulysis  of  the  robot 

The  robot  under  development  is  designed  to  operate  autonomously  performing 
tasks  ui  areas  difficult  to  access  with  a  human  opeiator.  One  such  task  is  performing 
eatemal  Inspechons  on  aircraft  skin  jomts.  On  an  aircraft  like  the  Boemg  747,  it  would 
be  possible  for  the  robot  to  fall  over  3  meters  unobstructed  (not  includuig  the  tail 
secuon).  A  3D  simulatton/ammahon  program  has  been  developed  so  that  the  robot 
response  as  a  result  of  a  fall  is  observed.  The  goal  was  to  create  a  geometry  model 
which  uses  dynamic  performance  of  the  robot  to  control  its  mouon  during  the  fall.  From 
the  dynamic  analysis  results,  graphical  ammauons  of  the  robot  were  produced.  In  order 
to  obtain  realistic  represenuuon  of  the  robot,  a  shading  technique  was  employed.  The 
developed  3D  animation  algonthm  is  geometry  mdependent;  hence  it  can  be  used  to 
animate  variety  of  different  mechanical  systems  without  rewnung  or  modifying  the 
program. 

The  robot  under  considerauon  is  sometimes  an  open-loop  and  someumes  a  closed 
loop  system.  Hence  the  differenual  equanons  of  the  monon  of  the  robot  were  formulated 
usmg  Cartesian  coordinates.  The  use  of  Caitesian  coordinates  and  the  resulung 
formulauon  of  the  equauon  of  mouon  m  a  Newtonian  form  allow  the  modelimg  of  both 
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open  and  closed  chain  systems  in  a  simple  manner  Funhermore.  it  enhances  the 
simplicity  of  the  numencaJ  formulation  or  generation  of  the  governing  equations,  and  the 
numerical  development  of  the  solutions.  A  general  body  "i"  of  a  muliibody  system  under 
consideration,  such  as  the  robot,  is  shown  m  Figure  7  A  set  of  local  body-fixed 
coordinate  axes  with  ongm  at  the  element  mass  center  C,  is  attached  to  the  body 

To  describe  the  configuration  of  the  body  m  a  non-moving  reference  frame  xyz.  it  is 
sufficient  to  specify  the  spatial  location  of  point  C.  and  the  angular  onentauon  of  the 
local  axes  A  vector  of  Canesian  coordinates  for  the  body,  q„  contains  r,  =  [x.  y,  z]/ 
2ind  p,  =  [Co,  e^]^  =  (Cq,  e,,  Cj,  e,]^  The  four  parameters  eo,  e,,  e^  and  Cj  form  a  set 
of  normalized  quaternions,  known  as  Euler  parameters  descnbing  the  rotational 
configurations  [19].  The  parameters  are  descnbed  below  as: 


•  cos(^) 

(11) 

.i<sin(|) 

(12) 

(13) 

where’  u  describe  the  onentaiional  axis  of  rotation,  and  ^  is  amount  of  rotation  For 
an  unconstrained  body,  the  translational  and  rotational  equations  of  motion  are  given  as 
follows: 


'ft 


(U) 


whtre  m„  represent  mass  of  the  body  "i",  r„  acceleration  of  the  mass  "i"  after.  J,  its 
inertia  tensor:  u’  and  u’  its  angular  velocity  and  acceleration  respectively;  f„  n'l  are  the 
forces  and  moments  acting  on  the  body  'i'  respectively.  For  a  constrained  system,  such 
as  the  robot  with  its  legs  either  attached  to  the  surface  or  not.  constraint  equation  ♦  exist, 
which  descnbes  the  dependency  of  coordinate  q;  i.e., 

4>.q)(q).0  (‘6) 

The  differential  equation  of  motion  m  the  mainx  form  will  be  in  the  following  form. 

Mq  •  g  * 

where 

M  IS  the  system  mass  matnx; 
q  is  the  system  acceleration  vector; 

g  contains  the  applied  and  the  gyroscopic  forces  and  moments, 

X  contains  a  set  of  Lagrange  multipliers  associated  with  the  constraints, 

'!■/>  denotes  the  forces  applied  at  the  joints. 
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Figure  7  Configuration  of  body  "i"  with  respect  to  xyz  coordinate  system. 

Corresponding  to  these  second-order  differential  equations  of  motion,  twice  as  many 
initial  conditions  are  needed  on  the  coordinates  q  and  the  velocities  q  as. 

For  these  mixed  differential-algebraic  equations  of  motion  for  the  robot  were 
solved  by  a  simple  numerical  algorithm  The  second  time  derivatives  of  the  constraint 
equations  were  appended  to  the  differential  equations  of  motion  to  form  a  linear  set, 
which  at  any  instant  can  be  solved  for  the  system  acceleration  and  Lagrange  multipliers 
A  direct  integration  method  using  the  Cartesian  coordinates  and  velocities  as  the  siate 
variable  ot  integration,  together  with  a  fonh-order  Runge-Kuia  with  an  adjustable  siep 
size  were  employed. 

For  a  simple  falling  of  the  robot  in  a  plane,  with  no  other  external  forces  other 
than  gravity  acting  on  the  robot,  the  analysis  reduces  to  a  two  dimensional  analysis  For 
other  conditions,  the  3D  analysis  must  be  performed  Either  way,  the  trajectory  of  the 
climbing  robot  can  be  obtained  under  the  action  of  different  loads.  In  order  to  visualize 
the  dynamic  behavior  of  the  ROSTAM  III  dunng  its  fall,  the  result  of  the  simulation  has 
been  converted  to  an  animation  program 

In  the  analysis,  the  nghl  leg  was  assumed  to  be  in  the  extended  form  and  the  left 
leg  in  the  retract  form  Three  test  cases  were  used  to  evaluate  performance  and  establish 
rate  requirements  for  the  leg  pivot  motor  All  cases  initialized  the  robot  with  zero  rates 
and  accelerations  and  the  legs  positioned  at  zero.  Starting  attitudes  of  the  robots  body 
were  chosen  as  90”,  130”,  and  180°,  and  the  result  of  animation  are  shown  in  Figures 
8,  9,  and  10  respectively.  No  cases  less  than  90”  were  chosen  because  it  is  assumed  the 
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Figure  8  The  simulation  of  the  robot  falling  with  a  90'  angle 


Figure  9  The  simulation  of  me  robot  falling  with  a  120'  angle. 
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Figure  1 1  The  angular  posiiion  of  the  robot  components  with  respect  to  inertial  frame 


Velocity  VS.  Time 


c*ntr8d  bo<^ 
t«tt  i«g 
nght  l«g 


Figure  12  The  velocity  of  the  robot  component  with  respect  lo  menial  frame 


robot  would  slide  until  an  edge  was  reached.  Minimum  height  that  the  system  should 
respond  in  is  initially  taken  to  be  1  3  meters  Final  values  for  survivable  height 
would  be  determined  by  how  fragile  the  payload  is.  Figures  ll.  and  12  show  the 
angular  position  and  velocity  of  the  each  component  of  the  robot  dunng  the  fall 

6.  Conclusion 

A  descnption  of  ROSTAM  HI  (Robotics  System  for  Total  Aircraft  Maintenance)  was 
presented  in  this  paper  which  has  two  legs  and  a  central  rotational  pan  for  us 
movement.  This  robot  was  used  to  provide  a  prototype  for  the  funher  needed 
research  m  the  area  of  climbing  robots  It  was  shown  that  these  robots  can  climb  on 
any  inclined  plane,  including  vertical  walls  and  ceilings.  The  safety  analysis  based  on 
the  assumption  of  the  lineai  of  the  reaction  force  was  developed  for  a  general  case, 
and  the  robot  has  proven  to  be  safe  for  all  conditions  Suction  cups  were  suggested 
for  the  adhesion  of  the  robot  to  the  surface,  because  they  can  suck  to  most  type  of  the 
maicnals.  Finally,  in  case  the  robot  falls,  a  method  was  developed  to  save  the  robot 
and  us  expensive  equipment.  'Hie  results  of  this  analysis  show  that  the  protection 
system  is  viable  The  animation  and  simulation  program  have  proven  to  be  very 
useful  tool  m  evaluating  the  robot  performance  dunng  the  fall. 
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Symbolic  Computations  in  Flexible  Multibody  Systems 
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V/-7000  Stuttgart  80 
Germany 


Abstrta  The  cecd  for  con^ter  aided  eagioeencg  in  tbe  asalym  of  macfu&es  and  roecfianiMDs  led  to  a 
Nbide  vanety  of  general  purpose  prx/;r2ans  for  tbe  dynamical  analvm  of  myJtibody  systems  Tbe  use  ot  more 
li^cweigbt  structures  and  an  tncrea&mg  demand  of  &lgii>precuion  mecbanisms.  such  as  robots,  led  to  ibe 
iflcorponuon  of  flexible  bodies  m  tius  metbodology  Ibis  paper  presents  a  formalism  for  flexible  mulb'jody 
systems  based  on  a  mmimum  set  of  genenliaed  coordinates  and  symbolic  computaoon  A  staodr.rdized 
object  onented  data  model  is  used  for  tbe  system  mamces  descnbtng  tbe  elasiodynamic  behaviour  of  the 
flexible  bodies.  ConsequcLdy.  tbe  equauons  of  oioqoq  are  denved  in  a  fonn  mdependent  of  tbe  cboseo  mod* 
elllng  tecbmque  for  tbe  elastic  bodies 


1  Introduction 

Mulubody  dyoamics  evolved  a  quarter  of  a  cemuiy  ago  from  the  need  to  siuulaie  the  dyoamlcai 
behaviour  of  spacecrafts  aud  machloes.  Nowadays,  the  method  of  multibody  systems  is  well 
established  and  accepted,  once  it  proved  to  be  a  vslu^ie  tool  io  the  dynamical  analysis  of  mecha* 
msms  such  as  robots,  vehicles,  aod  spacecrafts.  Eaily  works  focused  on  the  development  of  meth¬ 
odologies  for  ngid  bodies  only.  The  need  to  model  as  well  the  small  structural  detormaoons  led  to 
hybrid  models.  Likins  (IS)  introduced  hyt^  coordinates  to  Uie  mulubody  approach  and  the 
Finite  Element  community  developed  fonnuiatioos  to  take  into  account  the  gross  motion  of  the 
structural  system,  e  g.  Belytschko  aod  Hsieh  (4)  From  these  works  the  wide  held  of  flexible  mul¬ 
tibody  systems  evolved.  Presently,  modelling  techniques  for  flexible  multibody  systems  can  be 
ciassihed  into: 

•  Finite  element  approaches  using  a  oonlinear  formulatioo  and  absolute  coordinates,  e  g 
Cardona  aod  Ceradln  (6). 

•  Mulubody  approaches  aesumiog  a  large  gross  motion  and  either  small  elasUc  deformations, 
e.g  Shabana  and  Wehag^  (23).  or  nonlinear  deformations  due  to  geomeinc  or  matenal  non- 
une^nes.  e  g.  /^.nbrdsio  and  Nlkravesh  (1). 

This  paper  focuses  on  the  muldbody  approach,  which  is  very  efficient  from  the  computaaonal 
point  of  view.  Mulubody  models  consist  of  rigid  and  flexible  bodies  mierconnected  by  joints  and 
force  elements,  as  massless  springs,  dampers,  and  acuvely  controlled  elements,  see  fig  I  The 
joints  have  different  properues  and  constmia  the  modon  of  the  bodies 
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ftg  1  SchefTUticrcprcsenuuonofamuItjbodysystenn 

In  the  multibody  approach,  techniques  for  the  lacoiporation  of  flexible  bodies  are 

*  The  superelement  technique  where  a  flexible  body  Is  described  as  a  series  of  ri^d  bodies 
Interconnected  by  elastic  force  eiemeots.  Rauh  and  Schlehlen  ( 19]. 

•  The  continuum  approach  where  a  flexible  body  is  discretized  using  either  global  or  local 
shape  functions.  e.g  Shabaoa  and  Wehige  {23).  A  variation  of  this  approach  is  the  lumped 
mass  .rmulailon.e.g.  KimandHaug{14) 

With  the  avalliblUty  of  powerful  general  purpose  computer  algebra  systems,  such  as  MAPLE 
(7),  MATHSMATICA  (29).  MIOM  (12).  and  RECUCi  (5).  symbolical  computations  are  becoming 
more  and  more  an  important  tool  in  englneeriog  analy^s  IToblems  are  rather  solved  la  an  analyt* 
(cal'oumerical  way  than  in  a  pure  numerical  way.  see  e  g.  the  flnlic  element  approaches  of  Belizer 
(3)  and  loaldmldis  { 1 1).  The  use  of  computer  algebra  may  greatly  reduce  the  effort  for  oumer'icai 
calculations  *od  fadlluies  the  physical  interpretation  of  the  solution. 

SymboUcal  formalisms  for  the  dynamical  analysis  of  rigid  muliibody  systems  are  successfully 
used  for  more  than  a  decade.  Schichlen  and  Kreuzer  (21 )  The  symbolical  generation  of  the  equa* 
tions  or  motion  is  particularly  attractive,  since  the  equations  of  motion  are  derived  in  an  explicit 
form.  multipUcations  with  zero  elements  are  avoided,  and  the  numerical  procedure  of  time  inie- 
graiion  i;  d^upleo  from  the  derivation  of  (he  equations  of  motion,  i  e.  ihe  equations  of  motion 
have  to  bs  generated  only  once.  Nevertheless,  thera  are  limitations  in  symbolic  computing,  in  par- 
ticular  lor  flexible  multibody  systems.  Drawbacks  are.  that  only  simple  structural  elements  can  be 
described  by  means  of  a  symbc^Uc  approach  for  the  displacement  held.  Deltzer  (3).  Furthermore  a 
large  number  of  degrees  of  freedom  may  result  in  long  expressions,  which  may  be  difficult  to  han¬ 
dle  by  a  counter  algebra  system. 

These  drawbacks  seem  to  be  the  reason  that  in  a  recent  overview  of  available  mulubodv  codes, 
Schlehlen  (22).  none  of  the  reported  symooUc  fonsahsms  was  able  to  deal  with  flexible  bodies. 
There  Is.  however,  some  recent  work  dealing  with  symboUcal  formalisms  for  flexible  bodies,  e  g 
Ider  and  Amirouche  ( 10]  and  Salecker  (20),  but  so  far  they  are  resmeted  either  to  a  certain  class  of 
bodies,  mostly  beams  or  misses,  or  to  planar  problems. 

The  scope  of  this  paper  is  to  present  a  formulation  of  the  equations  of  motion  for  flexible  bodies 
uodergoicg  3  large  gross  motion  and  small  elastic  deformations  overcoming  above  menuonsd 
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drawbacics.  A  minimum  set  of  generalized  coordinates  is  used  to  generate  the  equations  of  mouon 
in  a  compact  form  suit^le  for  symbobc  computation  A  standardized  object-onented  data  base  is 
used  as  an  interface  to  numerically  precomputed  dau  describing  the  eiastodynamical  behaviour  of 
a  dexible  body  The  computer  algebra  system  \4APL£ts  used  for  the  generation  of  the  equauons  of 
mouon  m  terms  of  the  objects  of  the  data  model  Since  not  all  symbolical  terms  can  be  traced  back 
10  mput  variables,  the  equauons  are  denominated  semi*symboIical  equauons  of  motion 


2  Kinematics 

The  kinematic  descripdon  of  flexible  and  rigid  bodies  is  done  through  the  introduction  of  moving 
reference  frames.  The  moUoo  of  a  flexible  body  is  described  by  the  large  nonlinear  mouon  of  its 
reference  frame  which  is  referred  to  as  a  “rigid’**body  motion,  and  by  small  elastic  deformaoons 
within  this  reference  frame,  see  fig.  2 


KINEMATICS  OF  FLEXIBLE  BODIES 

The  position  and  oiieotatioo  of  the  reference  frame formed  by  the  vector  basls^e  with  a  s 

1(1)3,  relative  to  an  Inertial  frame  a  «  1(1)3. 1$  given  by  the  translational  veaor  r  and  the 
rotauooil  tensor  5,  respectively  Denoting  the  location  of  a  volume  element  dV  in  the  undeformed 
conflguradon  by  c  and  the  dispiacemeut  held  of  the  flexible  body  by  u  s  u  rj.  the  position  of  the 
volume  eiement  dV  with  respea  to  the  reference  frame  is  expressed  as 

d(c,t)  =  c-t  u(e,f)  (1) 

To  anive  at  a  mimmum  number  of  degrees  of  freedom  the  displacement  vector  u  is  expressed  as  a 
linear  combinauon  of  selected  deformation  modes. 

u(c,  i)  =  fP(c)q{t) .  (2) 


367 


where  ?  are  the  generahaed  elastic  coordinates  Methods  for  the  selection  of  defonnauon  inodes 
within  flexible  multibody  systems  are  presented  by  Kim  and  Hang  [K)  and  by  Meirovitch  and 
Kwalc  (17),  Using  the  fimte  element  method,  the  global  shape  fiincnons  *  are  written  as 

<I>  =  S^ASBT.  (3) 

Where  A  js  the  clement  shape  fiinction  matrU.  5  and  S  are  the  appropriate  transformauon  matnces 
from  the  eiemem  to  the  reference  frame,  A  is  the  Boolean  matnx  de&cnbiog  the  assemblage  of  the 
i^te  elements,  and  T  denotes  the  modal  matrix  The  defonnation  of  the  elastic  body  results  in 
strains  and  a  state  of  stress  w  thlo  the  volume  element  dV.  Strains  are  measured  by  the  Green* 
La^ange  strain  tensor  whose  components  are  written  as 


I  3u, 


The  strain  veaor 

e  =  U„  Cjj  £„  2£,j  2£3,1''  =.  (5) 

is  decomposed  into  a  term  linearly  dependent  on  the  displacements  u.  and  a  nonlinear  term 
e^t, .  It  has  to  be  pointed  out  that  due  to  the  large  displacement  of  the  flexible  body  the  second 
ordenerm  has  to  be  considered  in  eq.  (5).  Using  appropriate  differential  operator  masices  A 
and  Alu) ,  eq  (5)  is  rewnneo  as 

e  *  AU'*‘Alu)u  .  (6) 

Substituting  the  displacement  field  by  eq.  <2}  yields 

e^Lqi‘Uq)q  (7) 

where  L  and  Uq)  are  the  linear  and  the  nonlinear  strain  matrices  rerpecdvely. 

The  second  Pio'a*Klrchhofr  stress  tensor  is  the  energetic  conjugate  measure  to  the  Green- 
Lagrange  strain  teii>,'r.  It  is  related  to  the  strain  tensor  by  the  constitutive  equation 


Here  H,jtt  represents  the  material  constitutive  tensor  and  is  the  initial  or  nominal  state  of  stres' 
due  to  the  gross  body  mot:oa. 

KINEMATICS  Of  FLFjClBLE  MULTIBODY  SYSTEMS 

Kinemauc  relations  derived  so  far  describe  a  single  Cexible  body  undergoing  a  large  “rigid"  body 
motion.  A  closer  look  at  the  topological  description  of  a  system  of  rigid  and  flexible  bodies  is  now 
necessary.  For  the  example  in  fig.  3.  the  position  and  one&iauon  of  the  frame  j  is  desrnbed  by 
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Tig.  3  Simple  muitjbody  system  consisting  of  a  ngid  and  a  flexible  body 

where  rij  and  Sfj  denote  the  translational  vector  and  the  rotational  tensor  from  the  coordinate 
frame  t  to  the  frame  j.  Similarly,  the  mouon  of  the  coordinate  system  k  attached  to  the  elasuc  body 
is  given  by  the  following  recursive  formula 

(>» 

Si  =  S^Sjj.  (12) 

In  die  following  only  elastic  IxxUes  will  be  considered.  Rigid  bodies  can  be  dented  as  a  speaal 
case  of  elasdc  bodies  wbeie  die  displacement  fleld  u  is  aefo.  Diffeiendadng  eqs  (11)  and  (12) 
with  respect  to  dme  yields  die  absolute  velociUes  and  die  absolute  acccleiadons  as 


(U) 

(14) 


(15) 


“a  =  ®a  =  “y+«;»  +  ®y«ya  «« 

where  the  left  subscript  denotes  the  coordinate  frame  to  which  the  ume  derivation  is  referred  to 
Subscripts  or  superscripts  denoting  the  inertia  frame  are  generally  ooutied  The  skew  symmetric 
tensor  m  of  the  angular  velocity  is  found  as 

aj  =  S,sJ.  (17) 

Consider  now  a  muitlbody  system  of  p  ngid  o(  elastic  bodies  and  h  holononuc  constraints.  The 
system  holds  /  degrees  of  fre^m 


369 


/  s  6p-ft  +  n, 


(18) 


1 ' 

and  IS  umquely  descnbed  by6p’h  generalized  coordinates >.  describing  the  “ngid''-body  mouon 
of  the  flexible  bodies,  and  by  generalized  elasuc  coordinates  q  describing  the  elastic  detonna- 
tions  Let  the  vector  of  the  generalized  coordinates,  denoted  byy^ .  be  wnnen  as. 


y  [ 


(19) 


For  a  flexible  multibody  system  the  absolute  transiationai  accelerations  and  roiauonai  accelera¬ 
tions  Oj,  in  terms  of  the  geoerabzed  coordinates,  are: 

“y  =  0  •  oo' 

7g  J  g 


do) 


3ai. 


(21) 


Applying  e^s.  (20)  and  (2 1 )  to  eq.  ( 13)  the  icceloanon  may  now  be  expressed  in  terms  of  the  gen¬ 
eralized  coordinates  y,  as 


(22) 


where  the  3x/  Jacobian  matrices  are  denoted  by  zadjuvxdiht  veaors  of  the  local  accelerati¬ 
ons  are  detkxed  by  a  and  a. 


3  Dynamics 

The  equations  of  motion  for  a  multibody  system  with  flexible  member^  are  tor  a  holonomic  sys¬ 
tem  denved  by  D’Alemben's  prinaplc 

p 

2^  ^||8r''(pa-/-)<fl'+j5e''o‘yv-.  vVdA  j  =0.  (23) 

The  vinual  work  of  the  cooscratat  forces  vanishes 

irY=0  (24) 

Therefore,  only  applied  forces/^  have  to  be  considered  m  eq.  (23) 

LINEARIZATION  OF  THE  GENERALIZED  ELASTIC  COOkCINATES 

Up  to  tills  point  the  formulation  is  noalinear.  The  question  remaining,  therefore,  is  ho^  far  it  is 
necessary  to  use  a  noniinear  description  to  amve  at  an  accurate  and  compuuhonal  efncieoi  model 
Lineanzauon  of  the  elasnc  deformations  within  the  reference  frame.  >  e  assuming  only  small 
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deformauons  around  the  undeformed  conhgurauoa  is  a  common  approach  to  gam  computationai 
efhciency.  e  g  Shabana  [24]  Focusing  on  the  vtnuai  vrorV.  of  the  imemai  forces,  eq.  (23)  is  w-ntten 
as 


) .  1  vv  h 


(25) 


With 

R  =:  |SrVi/.4- j8r^(pn-/^)tiV  (26) 

A  V 

Neglecting  terms  of  second  order  m  q,  eq  (25)  is  wniten  in  a  more  compact  form  as 
p 

(27) 

1 

The  matrices  Ki  and  denote  the  linear  sufKness  matnx  and  the  geomeinc  stiffness  mainx. 
respecdNCly.  The  generalized  forces  related  to  the  actual  state  of  stress  are  (footed  by  the  vector 
/<'( 


V 


(28) 


{q)eW. 


(29) 


/■'=  (30) 

The  equations  given  above  represent  the  principle  of  vuiual  work  for  a  muiUbody  system  with 
Qexible  bodies.  Uncanzed  in  the  generalized  elastic  coordinates.  It  is  important  to  note,  that  Kf^i 
represents  a  hrst  order  tarn  in  the  dynamical  equations  based  on  kioematicai  terms  of  second 
order,  i  e  the  strain  matrix  UqX 

TIME-INVARIANT  SYSTEM  MATRICES 

Evaluating  all  the  volume  integrals  in  eq.  (27)  u  a  lengthy  process.  In  order  to  reduce  the  compu¬ 
tational  burden  during  simulanoo.  the  integrals  are  expre^ed  by  generalized  elastic  coordinates 
and  by  system  matnces  v^hich  are  time-invariant,  and.  therefore,  prccomputable.  The  inenia  ten¬ 
sor  of  a  Gexible  body  ser/es  as  an  example  to  illustrate  this  process: 

liq)  3  -jpdidV  =  -jpccdV-  jpeudV-jpucdV-jpuudV .  (31) 

V  V  V  V  V 

Using  eqs.  (2)  and  (3)  Um  uxiua  tensor  can  be  also  wntten  in  index  notauon  as 
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(32) 


-0 

With  the  ome-invanani  matnc«  and  Cg^t,,  uhere  represents  the  constant  inenia  tensor  of 
the  ngid  body,  and 


Table  1  presents  all  volume  integrals  of  eq  (27).  the  coirespoodihg  expression  in  index  noiatioo, 
and  the  corresponding  time-invariant  system  matrices.  The  corresponding  integrals  of  the  element 
shape  functions  for  a  Bernoulli  beam  element  were  derived  by  Shabana  (24} 


volume  integral 

index  notation 

FE-formulation  of  the  time-mvanant  system  matrix 

\pudV 

V 

jjx<tdV 

ci. 

1  ^,1  i 

4  V‘ 

l^pcudV 

1  y> 

jp^^io^dV 

t  yi 

jp^^aiudv 

1  yl 

Table  t  Time-tnvanant  ^em  matrices 


STIFFNESS  PROPERTIES 

In  the  followmg  the  integrals  of  eqs  (28)  to  (30)  are  considered  in  more  detail  The  evaluation  cf 
the  linear  stiffness  matrix  Ki  is  straight  forward.  Assuming  linear  elastiaty,  Ki  is  derived  from 
eq.  (28)  in  index  notation  as 

'  V* 

The  issue  of  the  sigmficance  of  the  geometric  stiffness  or  stress  stifhiess  matnx.  especially  m 
high-speed  mechamsms.  was  addressed  by  vancus  researchers,  e  g  Likins  (16]  and  Kane  et  ai 
(13).  Different  methcds  for  the  computation  of  the  stress  stiffness  matru  have  been  developed, 
e  g  Ider  and  Amuouche  (10)  proposal  an  explicit  sti^iess  matnx.  which  has  to  be  computed  at 


I 
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every  time  step  A  more  efficient  approach  is  the  superposiuon  method  as  proposed  bv  Walira;^. 
Santos  and  Ryu  (26](2fi]  and  by  Baneijee  and  Ehckens  (2U2).  Hq  (29)  indicates  that  the  geomemc 
stiffness  matrix  is  proportional  to  the  state  of  nominal  stress  which  again  is  proportional  to  the 
loads.  Assuming  the  linear  theory  of  elasticity,  umt  stress  stiffness  mainces  for  different  load  cases 
can  be  precomputed  17^  stress  stiffening  matrix  is  found  as  the  sum  of  the  individual  unit  matri¬ 
ces  scaled  viith  the  actual  load  at  time  integration.  To  evaluate  the  undeformcd  configuration 
has  to  be  analysed.  \q.  q^q^q^O  For  this  oinfiguration  the  state  of  nominal  stress  is 
quasi-statically  equilibrated  with  the  inertia  loads  and  tl^  applied  external  loads,  anu  is  com¬ 
puted  from  eq.  (27)  for  any  time  r. 

An  efficient  fonnulatlon  of  the  superposidon  method  is  obtained  using  the  properties  of  the 
Bernoulli  beam  Assuming  an  one-dimensional  state  of  stress  and  neglecting  shear,  the  consistent 
element  geometric  stiffness  matrix  for  a  Bernoulli  beam  element  has  the  form 


lo  t<^le  2.  the  individual  stress  stiffness  matrices  are  shown  fc^  a  structure  made  out  of  Bernoulli 
beam  elements  with  length  I  and  cross  section  F.  Hie  total  length  of  this  straight  structure  is  L 


load  case 

md.  svess 
stiffness 
matrix  Kffi 

volume  integral 

f£-formuiaiion  of  the  bme->.nvanant 
system  matrix  for  a  straight  BemouUi 
beam 

longitudinal  force/; 

- 

♦  -  -  JrVc'a'r? 

translational  acceleration 

cHd/t/, 

c\n)  - 

C'  •  J,'-pFTVjG‘(L-c,)llxB‘Tl 

rotational  acceleration 

V 

centrifugal  acceleration 

c\q)hh 

.  jc<>t)dVC^  •  '£'.pFTh‘’^jC‘iL^ -c])dxBfTq 

Table  Z  Individual  stress  stiffness  matrices  for  a  straight  gemoulii  beam 


li  was  pointed  out.  that  kinematic  icrms  of  second  order  zre  necessary  m  order  to  dcscnbe  the 
geometric  stlffiiess  correctly  By  compansoo,  the  term  0,5^q)  is  Identified  as  the  one  to  modify 
the  global  shape  tuocooo  in  second  order.  Terms  represenang  the  geometnc  stiffness  are  ihen 
incorporated  in  the  mess  matrix  and  in  the  vector  of  (he  gyroscopic  forces. 

STANDARD  INPUT  DATA 

A  cu.'TCDt  issue  10  tlie  development  of  software  tools  for  the  computer  aided  analysis  of  mechani¬ 
cal  systems  is  the  data  transfer  berueen  dlffeioat  programs  or  modules  Within  the  German 
research  project  Dynamics  of  Multibody  Systems  an  object-oriented  data  model  has  been  devel¬ 
oped  by  Otter  et  al.  ( 18]  This  allows  not  only  the  communicaiioo  between  different  modules  of  a 
complex  software  package,  but  defines  also  a  clear  interface  to  other  {^grams.  Wallrapp  {28] 
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extended  this  objea-onented  data  model  to  flexible  bodies.  The  basic  idea  is  to  collea  the  tune- 
invariant  system  mamces  at  a  very  high  abstraction  level  in  a  data  mode),  see  table  3. 

Through  a  Taylor  expansion  of  an  object  M,j,  e  g.  a  time-invanant  system  matrix,  in  the  form 

(36) 

linear  or  nonlinear  models  of  the  flexible  body,  derived  either  by  continuum  or  by  flnite  element 
methods,  may  be  incorporated  in  the  dat^ase.  Due  u>  the  object-oriented  ii^iroach  the  user  has 
access  to  such  objects  as  the  structure  of  a  m^x  expansion.  This  is  particularly  anractive  for 
symbolic  computing.  Without  knowing  the  values  of  the  matrix  elements,  the  soucnite  of  a 
matrix,  e  g.  diagonal  or  unit  matrix.  Is  accessible  In  the  data  model.  The  use  of  such  objects  may 
considerably  reduce  the  overhead  for  the  symbolical  generation  of  the  equations  of  motion.  All 
Terms  describing  the  elastodynamlc  behaviour  of  a  flexible  body  are  Incorporated  in  this  data 
model. 


description 

dimension 

computation  rule: 

mdf 

matrix  of  mass  times 
positlonof  centre  of  mass 

3x1 

»  JpedV 

1/1  _ 

1 

inertia  tensor 

3x3 

JH°m.  jpicdV 

Ct 

coupling  matrix  with 
rotational  coordinates 

n,x3 

•  £"■ 

Ck 

coupling  matrix  with 
rotational  coordinates 

n,x3 

«£ 

mais  matrix  of  flexible  body 

nqXOq 

gyroscopic  matrix  for 
rotational  coordinates 

3xti(,x3 

•  -K* 

Oe 

gyroscopic  matrix  for 
elastic  coordinates 

n,xtv,x3 

Os 

centrifugal  matrix  for 
elastic  coordinates 

3xnqX3 

stiffness  matnx  of  flexible  body 

OqXOq 

De 

damping  matnx  of  flexible  body  n^^  x 

•  oC’  +  ;3«t 

Table  3  Computing  some  of  the  classes  of  the  standard  input  data  using  a  FE-approach 
Equations  of  motion  for  flexible  mulubody  systems 
Based  on  the  dau  model  the  equations  of  motion  can  be  formulated  as 


«(vy,(')  +  M3’, •)',)  +*((«■<)  =  «/(3',-3',)  .  (37) 

With  the  symmetnc  mass  matnx 
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p 

the  vector  of  the  generalized  gyroscopic  forces, 
p 

*£  =  ]£(  JfmB-Jjmd,(ii)a+J^mmd,(^)+2jjaCf^q)g+jlmd,ig)a+jlHq)tt+ 

1*  1 

jl(al(q)a*jlG^(q)aiq+jlCf(.q-)i*jlc^(q)a^-jlo^(,q)a*jlG^{q)aq)j 

(39) 

the  vector  of  the  internal  forces. 
p 

*/  “  2  ^  /e^E?  ■'■/F^E^ 
and  the  vector  of  the  generalized  forces 


(  JT'^g*Jlmdlq)g*jlCf(q)t)  * 

>-t  ' 

J.l " 

In  these  equadoos  the  matrix  represents  the  Jacobian  of  the  generabzed  elastic  coordinates 

iq, 

h  =  -A 

% 

Which  descnbes  how  the  vector  is  related  to  the  vector 


4  Generating  seml^symboikal  equation;  of  motion 

The  presented  formalism  is  implemented  m  a  genera!  computer  program  using  the  symbolical  for¬ 
malism  NSW£UL  and  the  con^niier  algebra  system  MAPLE.  The  fonner  is  a  specialized  computer 
algebra  system  designed  for  the  derivation  of  the  equations  of  motion  for  mechanical  systems  with 
rigid  bodies  only  NEWEUL  has  a  resuiaed  set  of  available  symbolic  operations  and  is  based  on 
index  coding.  Schiehlen  and  Kreuzer  (21).  MAPLE  is  a  multipurpose  computer  algebra  program 
for  numerical  and  symbolical  computations.  It  is  also  a  programming  language  supporting  proce- 
dura*  programming.  Char  et  al.  (7).  Compared  to  other  computer  algebra  systems.  MAPLE  uses  the 
r^pured  memory  in  a  very  economical  way.  Tbgether  with  the  possibility  to  generate  complete 
FORTRAN  and  C  programs.  MAPLE  is  well  suited  for  the  development  of  prototype  programs.  For 
this  purpose  the  lack  of  computational  speed,  compared  to  specialized  computer  algebra  systems. 
IS  acceptable. 
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reference 

MODEL 

_ undeformed 

reference  configuratjon 

^  ..  1 — 

ill 

natd  boov 

elastic  body 

'.Z' 

topology 

structure 

^ _ _  'v' 


GENERATION  OF  THE  EQUATIONS  OF  MOTION 

JU  A 

V 

symbol  manipulabon 

A 

V 

FE-preprocessor 

A 

V 

semi-symbolica! 
equations  of  motion 

V 

Starr  dardized 

obiect-onented  data  model 

SIMULATION  -  VISUAUZATION 

Fig  4  Sdiem«  of  a  dynanvca)  an^ysis  of  flexible  mechanical  systems 

Based  on  the  tinematical  relatloas  of  (he  flexible  mechanical  system  genersied  by  NfWcLfi.  the 
equations  of  motion  are  generated  m  a  semi'SymboUcal  form  using  MAPLB  as  a  symbolical 
machine  The  terminology  seim-symbcUcal  was  used,  since  not  all  symbolical  tenns  can  be  traced 
bade  to  input  variables.  Such  terms  are  for  examine  the  classes  of  the  data  model.  Tb  avoid  lumeC' 
essary  operations,  (he  ob  m  structure  of  a  matrix  is  utilized  to  define  the  classes  of  the  data  model 
m  such  a  way  that  zero'ooeranoos  are  eliminated  as  soon  as  possible.  Semi-symbolical  tenns  can 
not  te  interpreted  easily  In  a  physical  way,  but  they  lead  to  a  compuuiionally  effleiem  formulation 
overcoming  the  restriction  to  certain  types  of  models  f(»  the  elastic  body  In  order  to  keep  tne 
expressions  in  a  compaa  form,  repeat^  strings  of  synUxils  have  to  be  replaced  by  subsdtutlcn 
variables  This  can  be  realized  other  by  assigning  these  strings  to  an  arbitrary  substitution  variable 
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or  by  replacmg  them  by  physically  mterpretable  symbols.  Aexarople  for  such  a  physical  iiuopret' 
able  symbol  is  the  expression  of  the  third  compooem  of  the  a>  vector  by  01  ( 3 )  A  very  compact 
symbolical  form  of  the  equations  of  motion  is  achieved  by  using  the  recursive  kioematical  formu¬ 
las  and  replacing  the  strings  recursively  This  procethire  is  referred  to  as  recursive  compression. 

A  scheme  of  a  dynamical  analysis  of  flexible  mechanical  systems  is  depicted  in  flg.  4.  The 
equations  of  mouoa  are  generated  by  symbol  maiupulauon  based  on  the  topological  desenpoon  of 
the  system.  Independently  a  FE-;nq)roces$or.  currently  based  on  Bernoulli  beam  elements,  com¬ 
putes  numerically  the  dme-invariani  system  matrices  and  stores  them  in  the  data  model.  These 
matrices  are  read  into  in  the  semi-symbolical  equadoos  as  a  parameter  set  and  the  output  is  a 
ready-to-compile  FORTRAN  code  The  ordinary  differential  equations  are  then  integrated  using 
standard  algorithms,  see  e  g.  Gear  (9]  It  has  to  be  noted  that  the  modules  symbol  mantpuJation, 
FE‘preprocessor,  and  time  integration  are  indqiendefit.  connected  only  by  a  clearly  deflned  data 
model,  see  flg  4. 


5  Examples 

T\vo  examples  of  flexible  mechanisms  will  be  {xes/mted  the  well  known  example  of  the  rotating 
beam  and  a  flexible  robot. 

ROTATING  BEAM 


Fig.  5  Rotating  beam  and  imposed  angular  velocity  and  acceleration 

A  slender  beam,  length  10  m.  with  ar>  additional  tip  mass  is  rotating  around  a  hinge  with  a 
given  function  of  the  angular  acceleration  a.  It  represents  a  spm-up  manoeuvre  starting  at  ume 
1  s  0  s  and  ending  uT^  15  s  reaching  at  a  constant  angular  veloaty  s  5  rad/s,  sec  flg  S  The 
function  for  the  conrespondlng  angle  ^t)  is  given  as: 


<P(t)  : 


for  r<r 

for  isr 
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No  gravity  acts  on  the  beam  and  the  propenies  are  as  follows,  cross  section  area  A  s  0.0004 
area  moment  of  inertia  /j  *  2tl0^  rr^.  Youngs's  modulus  E  *  7xlO'^  N/n^,  and  mass  density 
p^SOOOkg/mK^tf  {10}. 

Ux{m)  UytmJ 


Fig.  6  Elastic  tip  displacemenu  and  Uy  of  the  rotating  beam 


Mass  matnx  in  symmetric  storage  mode: 

M(l)  •  LT2(l.2}**2*MULT2(2,2)**2*m*ME^el(l,l) 

M(2)  »  LT2(l.2)*LT2(1.3)*HULT2<2.2)»LT2(2,3)*MUME.el(l,2) 

M(3)  «  LT2(l,:)**2*Ml*LT2(2,3)**2»MUME^el(2,2) 

M(4)  •  LT2(l.2)*LT2(l.4)*Ml*LT2(2,2)*LT2(2,4)*Ml*KE.el(l,3) 

M<S)  *  LT2(l,3)«LT2{l,4)*Ml*LT2(2,3)*LT2(2.4)*MUME..el(2,3) 

M(€)  *  LT2(l.4)«*2*Ml4.LT2(2.4)**2»Ml*llE.el(3.3) 

Right  hand  side. 

iq#(l)  «  -LT2(l.2)*A0T2{l)*Ml-LT2(2,2)*AQT2(2)*Ml- 

0E,«l(l.3)»01(3)**2-GE_qp..«l(l,3)*01(3)-KE.®lU.l)*q^*l«l- 
(LT2li.l}‘LT2(l,2)’Hl*LT2r2.l)*L72(2,2)*Ml*CR.el{l,3))*AlPP 
iq®(2j  »  -LT2(1.3)*A0T2(l)*Ml-LT2t2,3)*AQT2(2)*Ml- 

OE^®l(2.3)*01(3>**2-GE_qp_el<2.3)*Ol(3)-KB^ol(2,2)*q_©l.2- 
(LT2{1. 1'  •LT2(l.3)*Ml+LT2(2,l)*LT2(2,3)*MUCR_©i(2,3y)*AlPP 
qe(3)  c  -l.T2(1.4)*AQT2{l)*Ml-LT2(2,4)*AQT2(2)*^Ml- 

OE_©li3.3)*Ol{3)**2-GE.qp_«l<3.3>*Ol(3)-KE_©l{3,3)‘q.«U2- 

;LT2a.l}*LT2(l,4)*Ml*LT2(2,l)*LT2(2,4)*«l»CR,el(3,3))*AlPP 

Notation. 

q«ol_l:«0)  OlsO  AIPP*  «  LT2:  yj7  AQT2;a2  _®l:  clasbc body  1 


Table  4  Semi^symboliai  equations  motion  for  the  rotating  beam 

The  ume  history  of  the  elasuc  displaceme&ts  u,  and  UyOf  the  Up  with  respea  to  the  undeformed 
state  of  the  beam  are  shown  in  hg  4  aod  are  compared  to  the  solution  obtained  with  the  hnite-ele* 
ment  code  ANSYS  [8]  A  very  good  agreement  of  the  solutions  was  obtained  with  the  presented 
formalism  The  reducuoo  of  the  model  resulted  in  a  strong  increase  in  computational  efilciency 
Modelling  with  ANSYS  was  done  using  10  2D*beam  elements  resulung  m  a  system  of  sparse  uif« 
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ferenuai  equations  of  dimension  33  For  the  presented  example  2  bending  modes  and  I  longitudi¬ 
nal  mode  were  selected  leading  to  a  very  compaa  system  of  ordinary  differential  equations  of 
dimension  3  The  equanons  of  mouon  are  presented  in  hg  4  They  have  a  very  compaa  form  and 
with  the  objea  definitions  of  table  3  they  can  be  easily  mterpreted.  Additional  equations  for  the 
taylor  expansion  of  the  data  objects,  eq.  (36).  have  to  be  generated.  They  are  omitiM  in  this  paper 
due  to  the  limited  space 

FLEXIBLE  ROBOT 

A  planar  flexible  robot  was  presented  as  a  benchmark  example  within  the  German  research  projea 
Dynamics  of  Mulnbody  Systems,  sec  Sorge.  Bremer  and  Pfelffer{251.  Gravity  'Adth  g-98l  m// 
acts  on  the  robot  and  material  prucenies  are  chosen  as  Youogs's  modulus  E  s  7,3x10^^  S/tr?, 
and  mass  density  p  *  2700  kg/rr  The  pomtmasses  are  selected  as  W,  =  /  ig  and  A/j  =  i  kg. 
Dimensions  of  the  undeformed  beams  are  for  beam  1:  x  a  0.54$  m,  y  a  0,01$  m.z^  0,06  m  and 
for  beam  ll:x  a  0.675  m.y  s  o.OI  m.z^  0.04  m  Thefuocdonsof  the  joint  angles  <9,  and  p]  are 
give .  ^ 


* 


•nIA 

»/4(-l+Ti(b 
s/4(-18l+l08<*-144r) 
*/4  (-8  +  54(-108(^  +  72(’) 
tUA 


for  r<0 
for  0S/<  1/6 
for  i;6Sr<l/3 
for  V3^t<\a 
for  1/2 


(44) 


^2  =  -^>2 

Three  dlsunct  points  have  to  be  calculated,  the  equilibrium  position  for  rs  pr.  and  the  two 
extreme  points  of  the  vibration  around  the  equilibrium  position  for  t>0.$s,  see  fig.  7 

{  reforence  solution  presented  forroAitsm  I 


[time  (s) 

x(m) 

yN 

time  ($] 

x(m) 

yN 

C 

1.057 

•0411 

0 

1  C57 

■0  410 

041 

1  019 

0599 

042 

1.019 

0592 

057 

1043 

0123 

057 

1  046 

0123 

Table  5  SeleaedposiUons  tor  the  robot 


Table  5  indicates  a  good  agreement  of  the  soluuoo  obtained  by  (he  presented  approach  with  the 
reference  soluuon,  sec  Sorge,  Bremer  and  PfeiffCTt25| 


Rg.  7  robot 

6  Conclusion 

Based  on  the  topological  descnptioa  of  a  multibody  system  with  flexible  members  the  equations 
of  modoo  were  denved  in  a  muumal  fonn  using  D*  Alemben’s  pnoaple.  System  mamces  desenb- 
mg  the  elastodynamical  bdiaviour  were  derived  lor  a  fmite  tiemeni  approach  and  the  geometnc 
sdflbess  matnx  is  given  for  the  case  of  a  straight  beam.  By  use  of  a  standardized  cbjea  onented 
data  base  it  was  shown  that  the  presented  fonnallsm  can  be  implemented  in  a  semi-symbolical 
form,  without  restnedons  on  the  type  of  modd  used  for  die  elasdc  body.  The  two  presented  exam¬ 
ples.  a  routing  beam  and  a  flexible  robot,  indicated  a  good  agreement  with  reference  soludons 
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Abstnet 

An  Approach  to  th«  compntcr  aided  analysis  of  flexible  mnltibody  sys* 
terns  nsing  object-oriented  programming  methods  is  presented.  The  aim  is  to 
support  the  rapid  generation  of  specialised  programs  by  providing  an  open, 
extensible  toolkit.  This  toolkit  contains  modules  (C++  classes)  which  al¬ 
low  the  declaration  and  manipulation  of  multibody  cociponents  such  as  joints, 
bodies  and  actuators  in  an  intuitive  manner.  New  components  (e.g.  new  finite 
elements)  are  easily  introduced  toextend  the  toolkit.  The  equations  of  motion 
for  a  multibody  system  consisting  of  these  component;  are  formulated  by  di¬ 
rect  application  of  the  prioaple  of  virtual  u^rk  using  symbolic  techniques.  It  is 
possible  to  use  absolute  as  well  as  rdative  coordinates  m  a  problem-dependent 
manner. 


1  Introduction 

hUlhods  for  the  computer-aided  analysis  of  multibody  systems  have  reached  a  high 
1  vel  of  maturity  and  are  being  increasingly  applied  to  real-world  problems  in  van- 
■jus  sectors  of  industry.  Powerful  programs  such  as  ADAMS,  DADS,  MECANO  and 
COMPAMM  have  established  themselves  as  standard  tools  within  a  CAE  environ¬ 
ment  and  are  being  rapidly  enhanced  to  meet  user  needs. 

While  such  programs,  with  sophisticated  graphical  user  interfaces  and  links  to 
other  analysis  tools  and  CAD  programs,  are  well  suited  to  the  industnal  context, 
research  in  multibody  methods  also  requires  a  kind  of  programming  environment  in 
which  rapid  experimentation  is  possible.  Such  experimentation,  which  might  ’uvolve 
using  completely  different  methods  for  formulating  equations,  companng  '  erent 
formulations  for  a  new  component  or  testing  new  numerical  solution  procedures, 
is  not  easy  with  existing  programs  and  conventional  programming  techniques.  A 


possible  alternati^'e  lies  io  the  use  of  object-onented  programming  to  create  toolkits 
from  which  researchers  can  rapidly  ^cuerate  customized  programs. 

One  such  approach  to  applying  object-oriented  programnung  techniques  to  the 
analysis  of  multibody  systems  (see  (Serge,  1992,  Kecskemethy,  1993]  for  other  recent 
work)  will  be  presented  in  the  following.  The  primary  aim  is  to  create  a  framework 
w’itfain  which  difiierent  types  of  coordinates  and  various  forms  of  equations  may  be 
experimented  with.  No  attempt  is  made  to  formulate  a  multi-purpose  program,  but 
as  will  be  shown,  the  resulting  toolkit  allows  formulation  of  specialized  simulation 
programs  at  the  same  level  of  abstraction  as  most  input  languages  for  multibody 
programs.  The  theoretical  background  is  described  in  Section  2  and  fundamental 
aspects  in  the  design  of  the  toolkit  are  discussed  in  Section  3.  A  key  element  in 
the  present  approach  is  the  combination  of  symbolical  and  numencal  computations 
in  a  set  of  classes  for  mathematical  quantities  introduced  in  Section  4.  Based  on 
these  mathematical  classes  one  can  dehne  abstractions  for  the  elem^mts  of  multibody 
systems  as  described  in  Section  5.  The  assembly  of  a  complete  mt>ltibody  system 
model  from  such  elements  is  demonstrated  in  Section  6  and  the  application  of  various 
analysis  procedures  to  such  a  model  is  shown  in  Section  7. 


2  Theoretical  background 

A  distinctive  feature  of  multibody  dynamics  is  that  no  single  method  has  established 
itself  in  the  same  way  as  the  finite  element  method  in  structural  dynamics.  In  the 
following,  the  major  current  approaches  or  '^formalisms’*  will  be  briefly  reviewed, 
focussing  on  the  type  of  coordinates  used  and  the  computational  tasks  arising  from 
assembly  of  the  dynamical  equations  of  motion*. 

Id  the  absolute-coordinaU  or  cartesian>coordinate  approach  (see  e.g.  [Nikravesh, 
1987]),  a  translation  vector  r  and  some  rotation  parameters  @  are  introduced  to  in* 
dependently  desenbe  the  motion  of  one  or  more  reference  frames  on  each  body  and 
are  collected  in  the  vector  of  generalized  coordinates  q  of  the  multibody  system.  The 
system’s  vector  of  generalized  forces  Q  is  composed  of  the  translational  force  /  and 
a  torque  t  applied  to  the  various  reference  frames.  Here  and  in  the  following,  we  as¬ 
sume  that  forces  also  include  inertial  forces  unless  otherwise  stated.  The  generalized 
forces  are  easily  formulated  by  additively  accumulating  contributions  from  dynamic 
elements  such  as  bodies,  springs  etc.  Joints  are  modelled  with  constraint  equations, 
which  are  simply  concatenated  to  form  the  multibody  system’s  constraint  equations 
g{q)  =:  0  Dynamic  equilibrium  is  defined  by  equating  the  generalized  forces  Q  with 
constraint  forces  which  are  formulated  with  the  help  of  Lagrange  multipliers  A 
and  the  constraint  Jacobian  G  For  the  solution  of  the  equations  arising  in  kinemat- 
ical  and  d>  namical  analysis  one  also  requires  the  mass  and  stiffness  matrices  and  the 

‘The  so-called  “recursive"  methods,  such  as  those  of  [Featherstone,  1987,  Bae  and  Haug,  1987] 
are  not  considered  here,  as  their  unique  combination  of  equation  formulation  and  equation  solution 
put  them  in  a  category  of  their  own 
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Jacobian  of  the  constraints  In  sparse  form.  All  these  operations  can  be  performed 
numerically  and  are  easy  to  automatize,  so  tb~t  this  is  the  method  of  choice  for  most 
large  commercial  multibody  program  packages. 

To  avoid  the  large  number  of  coordinates  and  constraint  equations  arising  in  the 
absolute-coordmate  approach,  the  nlaltte-cocrdinaie  or  joinUeoordmcie  approach 
(see  e  g.  (Wittenburg,  1977))  uses  natural  joint  coordinates  as  the  generalized  co¬ 
ordinates  q.  The  motion  of  reference  frames  is  now  expressed  in  terms  of  these 
joint  coordinates  by  formulating  the  functions  r(9)  and  R{q)  for  translation  and 
rotation.  Formulation  of  the  generalized  forces  Q  is  more  involved  than  in  the 
absolute-coordinate  approach,  as  a  force  or  torque  applied  to  a  reference  frame  may 
make  a  contnbution  to  any  number  of  components  of  the  generalized  forces.  Nu¬ 
merous  methods  have  been  developed  for  this  purpose,  based  on  diverse  mechanical 
principles  such  as  Lagrange’s  equations  of  the  second  kind,  Kane’s  equations  or  the 
principle  of  D’Alembert.  In  all  these  methods  the  crucial  step  is  to  accumulate 
projections  Jjf  and  J^t  of  forces  and  torques  acting  on  reference  frames,  using 
Jacobians  or  “velocity  transformations”  Jr  and  Jn  of  the  translation  and  rotation 
of  these  frames  Kinematical  loops  are  handled  by  setting  up  constraint  equations  in 
the  joint  coordinates,  which  are  concatenated  to  form  the  muUibody  system’s  con¬ 
straint  equations  ^(q)  =  0.  Dynamic  equilibrium  is  defined  in  the  same  way  as  for 
the  absolute-coordinate  method  by  equating  the  generalized  forces  with  constraint 
forces.  The  implementation  of  the  joiot-a>ordioate  approach  requires  some  sort  of 
topological  analysis  of  the  system  to  identify  kinematical  loops  and  formulate  the 
motion  of  all  reference  frames.  During  kinematic  and  dynamic  analysis,  first  the 
position  and  velocity  of  all  reference  frames  has  to  be  evaluated,  followed  by  compu¬ 
tation  of  absolute  forces  and  constraint  equations.  The  accumulation  of  generalized 
forces  then  proceeds  according  to  specialized  algonthms  generally  involving  recursive 
evaluation  of  the  Jacobians  Jr  and  Jr  or  recursive  application  of  their  transpose, 
(see  {Kecskemethy,  1993]  for  a  review).  Evaluation  of  the  mass  matnx  and  the 
constraint  Jacobian  is  quite  complex  and  very  few  algorithms  permit  evaluation  of 
stiffness  matrices 

The  mtmmaUcoordinate  approach  of  [Hiller  and  Kecskemetby,  1989]  is  a  form  of 
the  joint-coordinate  approach  specialized  to  systems  with  multiple  kinematical  loops, 
in  which  all  constraints  arising  from  the  kinematical  loops  are  solved  m  closed  form 
for  one  or  more  joint  coordinates  m  each  loop.  Only  the  remaining  joint  coordinates 
are  included  m  the  vector  of  generalized  coordinates  q.  Since  no  construnt  equations 
or  Lagrange-multipliers  occur,  the  number  of  coordinates  and  equations  is  minimal, 
but  the  formulation  of  the  closed-fonn  solutions  further  adds  to  the  complexity 
inherent  m  joint-coordinate  approeiches.  A  fully  automatic  implementation  of  the 
method  is  extremely  challenging,  but  a  semi-automatic  implementation  in  the  form 
of  a  C++  toolkit  is  described  in  [Kecskemetby,  1993). 

Each  of  these  three  approaches  has  its  advuitages  and  disadvantages,  so  that 
a  combined  approach  seems  promising,  in  which  a  suitable  combination  of  differ¬ 
ent  coordinate-types  can  be  used  to  take  advantage  of  the  special  structure  of  each 
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multibody  system.  Such  a  combined  approach  may  be  developed  as  an  extension 
of  the  joint-coordinate  approach,  as  the  underl3dng  mechanical  principles  in  general 
permit  the  use  of  any  other  type  of  coordinates,  including  absolute  coordinates.  New 
aspects  arising  in  such  an  extension  of  the  joint-coordinate  approach  are  the  speaal 
treatment  of  finite  rotations  (which  rarely  occur  as  ..>int  coordinates),  generaliza¬ 
tion  of  algorithms  for  the  efficient  evaluation  of  generalized  forces  and  exploitation 
of  sparsity.  The  present  approach  attempts  this  extension  of  the  joint-coordinate 
method  and  has  the  following  distinctive  features: 

•  Coordinates  of  any  kind  are  allowed,  e.g.  joint  coordinates,  cartesian  coordi¬ 
nates,  strain  measures  etc.,  but  a  distinction  is  made  between  a  “position”  and 
“velocity”  representation  to  support  the  use  of  parameters  of  finite  rotations 
(see  Section  5.1). 

•  Dynamic  elements  are  formulated  in  a  coordinate-independent  fashion  to  sup¬ 
ply  the  virtual  work  of  a  generalized  applied  force  (see  Section  5.3),  e.g  a 
translational  force,  torque  or  even  a  stress  measure  performing  virtual  work 
against  a  corresponding  virtual  strain  measure. 

•  Assembly  of  a  multibody  system  and  its  equations  is  based  on  the  applica¬ 
tion  of  symbolic  techniques  (see  Section  3  and  4),  which  obviates  the  need 
for  speaalized  algorithms  to  attain  efficiency  and  also  permits  exploitation  of 
sparsity. 

•  Computational  procedures  tor  the  analysis  of  the  multibody  system  (see  Section 
7)  are  based  on  a  special  model  of  numerical  procedures  (see  Section  4)  which 
permits  different  analysis  procedures  to  be  combined. 

3  Design  of  the  multibody  toolkit 

In  this  section  the  basic  design  of  a  toolkit  for  analysis  of  multibody  systems  in  the 
object-oriented  programming  language  C++  (Stroustrup,  1991)  will  be  discussed.  A 
discussion  of  object-onented  programming  as  such  and  its  advantages  with  respect  to 
other  programm'ng  paradigms  IS  not  possible  here  (see  e  g.  (Stroustrup,  1988,  Booch, 
1991)),  also  a  familianiy  with  the  basic  concepts  of  C++  is  assumed. 

Objcct-cricnted  programming  is,  far  more  than  conventional  procedural  program¬ 
ming  a  dc^  gn  task  and  the  key  element  of  “object-oriented  design”  [Boocb,  1991) 
is  the  identi.'cttion  of  classes  as  abstractions  of  entities  in  the  problem  domain  and 
the  definiticn  of  the  behaviour  of  these  classes.  Here,  the  problem  domain  is  the 
analysis  of  multibody  systems  and  it  is  natural  to  try  to  encapsulate  components 
of  multibody  systems  such  as  joints,  bodies,  forces  and  constraints  as  classes.  In 
general  (see  [Sorge,  1992,  Kecskemetby,  1983))  this  involves  defining  a  lower  level  of 
classes  for  standard  mathematical  objects  such  as  scalars,  vectors  and  matrices  and 


characterizing  the  behaviour  of  components  of  multlbody  systems  by  certain  typical 
computations  with  such  mathematical  objects  Considenng  the  diflerent  formalisms 
discussed  in  Section  2  it  is  immediately  obvious  that  different  formalisms  require  dif¬ 
ferent  computations,  e  g.  in  the  absolute-oiordinate  approach  a  joint  must  compute 
Its  constraint  equations,  while  in  the  joint-coordinate  approach  it  must  be  able  to 
compute  the  motion  of  the  outboard  reference  frame. 

We  may  say  that  different  formaltsms  imply  different  abstractions  and  this  ap¬ 
plies  to  an  even  greater  extent  to  the  treatment  of  the  multibody  system  as  a  whole, 
where  every  formalism  requires  its  own  global  data  structures,  leading  to  completely 
different  representations  of  a  multibody  system  as  a  class.  The  absolute-coordinate 
approach  essentially  requires  simple  mappings  between  quantities  such  as  state  vari¬ 
ables  and  forces  in  the  components  of  the  multibody  system  and  the  corresponding 
composite  quantities  in  the  multibody  system  While  the  order  in  which  computa¬ 
tion  are  performed  is  of  little  importance  m  the  absolute-coordinate  approach,  the 
joint-coordinate  approach  requires  recursive  computation  of  the  motion  of  reference 
frames  and  of  the  Jacobians  or  velocity  transformations,  generally  involving  some 
form  of  “tree”  or  “graph"  data  structure. 

Trying  to  encapsulate  such  diverse  abstractions  of  multibody  systems  as  a  col¬ 
lection  of  unrelated  classes  is  a  tedious  task  unless  one  recognizes  that  the  different 
concepts  have  much  in  common:  one  is  always  dealing  with  scalar,  vector  and  matrix 
/unctions  and  their  denvattves.  It  should  also  be  kept  m  mind  that  such  standard 
numerical  procedures  as  solution  of  linear  and  nonlinear  equations  and  numerical 
integration  require  some  representation  of  vector-valued  functions  and  their  partial 
derivatives,  preferably  as  sparse  matnx-v^ued  functions. 

Such  considerations  have  led  to  the  development  of  a  toolkit  for  multi¬ 
body  systems  in  which  the  main  emphasis  is  on  the  design  and  implementation  of 
mathematical  operations  This  resulting  toolkit  has  the  following  structure: 

•  A  module  for  symbolical  and  numerical  mathematics  defines  differentiable 
scalar,  vector  and  matrix  functions.  Such  functions  can  be  defined  as  ex¬ 
pressions  in  a  syntax  very  close  to  standard  mathematical  notation  and  an 
important  feature  is  the  assembly  of  composite  vec'ors  or  “hypcrvectors"  to 
represent  product  spaces. 

•  General  numerical  procedures  are  defined  in  an  abstract  sense  m  terms  of  such 
functions,  exploiting  the  ability  to  automatically  formulate  exact  derivatives 
of  scalars  and  vectors  as  vector  and  matrix  functions  (as  sparse  block-oriented 
matrices  or  “hypermatrices”  in  the  case  of  hypervrclors),  respectively 

•  Kinematic  elements  such  as  joints  and  constraints  recursively  formulate  func¬ 
tions  of  state  variables  using  the  facilities  for  expression  formation. 

•  Dynamic  elements  formulate  the  virtual  work  of  generalized  forces  against  vir¬ 
tual  displacements  as  a  real- valued  functional  and  the  constraints  formulate  a 
virtual  work  of  constraint  forces. 
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•  A  multibody  system  assembles  \ectors  sudi  as  state  variables  and  constraint 
functions  and  accumulates  virtual  work  from  its  components  Generalized 
forces  are  formulated  by  partial  differentiation  of  the  virtual  work  and  system 
matrices  such  as  the  mass  matrix,  stiffness  matrix  an  *  constr^nt  Jacobians  are 
formulated  by  partial  differentiation  of  the  generalized  forces  and  the  constraint 
function. 

•  Analysis  procedures  for  multibody  systems  are  simply  denved  from  classes  for 
general  numerical  procedures  and  essentially  extract  the  appropriate  function 
to  solve  and  the  vector  to  solve  for  from  the  multibody  system. 

Further  details  on  these  components  of  the  toolkit  will  be  given  in  the  following 
sections. 


4  Numerical  and  symbolical  computations 

The  classes  for  scalar,  vector  and  matrix  operations  mentioned  in  the  previous  sec¬ 
tion  will  be  introduced  “by  example”,  focussing  on  the  classes  for  vector  functions 
derived  from  the  base  class^  Rn,  but  the  design  of  classes  for  scalar  functions  and 
matrix  functions  (derived  from  R1  and  Razn)  is  similar.  Rn  is  an  abstract  base  class 
specifying  properties  common  to  all  vector  functions  (or  simply  “vectors”)  and  sub¬ 
classes  specialize  Rn  to  specific  vector  functions.  In  the  simplest  case  we  have  the 
subclass  RV«c  to  represent  independent  vectors  which  can  be  declared  just  like  an 
integer  or  real  number  with  statements  like 

RVec  X  (3,  0);  //  X  ■  (0,  0.  0) 

RVflC  y  <x) : 

RV«c  z  (x) : 

Vector  functions  are  generally  the  result  of  eipresston  formation  as  in 

RnJt  a  ■  X  ♦  y; 

Rnk  b  ■  X  X  y; 

for  the  sum  and  cross  product  of  vectors.  Here,  the  application  of  the  operator  “+” 
to  two  vectors  internally  generates  an  object  of  the  “expression  class”  RnPlusRn.  It 
must  be  stressed  that  this  sum  object  is  not  the  (constant)  value  of  the  sum  at  the 
point  of  declaration  but  represents  a  function  mapping  the  values  of  the  two  operands 
to  the  value  of  the  sum  at  any  time.  For  this  RnPlusRn  and  other  expression  classes 
store  references  to  the  operands  for  later  use.  Note  that  no  numerical  operations  are 
performed  at  the  time  of  expression  formation:  numerical  operations  are  performed 
during  subsequent  evc/uation  of  the  function,  e.g.  when  its  value  is  required  for 
evaluation  of  another  expression  or  if  it  is  to  be  printed  as  in 

^Typewriter  font  wiil  be  used  id  the  following  for  program  symbols  and  code 
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cout  «  a; 


An  important  feature  of  evaluation  is  value  caching,  i  e  on  subsequent  evalua¬ 
tions  a  stored  ('‘cached'’)  value  is  used  until  an  operand  changes  in  value.  Thus,  if 
immediately  after  the  evaluation  due  to  printing  shown  above  we  assign 

z  «  a;  //  Assignaent  only' 

the  sum  is  not  reevaluated,  but  'f  we  ass'^n  to  one  of  its  operands  as  m 
X  -  S; 

the  expression  a  is  notified  of  this  change  and 

z  *  a;  //  Evaluation  followed  by  assignaent* 

forces  a  reevaluation  Value  caching  is  exploited  by  the  mechanism  of  common  subei- 
presston  ehminatton,  which  guarantees  that  whenever  a  subexpression  equivalent  to 
an  existing  one  is  formed,  the  new  (“common")  subexpression  is  eliminated  and  the 
existing  subexpression  is  reused  Thus 

Rn4t  c  ■  z  X  (x  +  y); 

reuses  a  and  on  evaluation  of  c,  the  cached  value  of  a  is  used.  In  addition,  certain 
expression  simplifications  are  built  into  expression  formation,  e  g.  the  cross  product 
of  a  vector  with  itself  creates  a  “zero  vector"  or  ZeroRn  and  use  of  this  ZeroRn  id 
subsequent  expressions  results  in  its  elimioation. 

Expression  formation  can  proceed  recursively  to  any  level  of  complexity,  leading 
to  the  formation  of  large  numbers  o^  expression  objects  linked  to  one  another  u  the 
form  of  “expression  trees".  By  virtue  of  expression  simplification,  common  subex¬ 
pression  elimination  and  value  caching,  these  expression  trees  automatically  acl  t 
mo^t  of  the  optimizations  typically  found  m  specialized  m'dtibody  algorithms,  so 
that  the  need  for  such  algorithms  practically  vanishes. 

Another  important  operation  is  symMic  differentiation,  wh’ch  allows  the  formu¬ 
lation  of  exact  derivatives  of  a  vector  function  with  respect  to  on**  of  its  operands  as 
in 


Raxnl;  da.z  ■  a.d  <z) ; 

and  makes  the  formulation  of  muUibody  system  matrices  such  as  Jacobians.  mass 
matrices  and  stiffness  matrices  by  hand  unnecessary. 

While  expression  formation  and  differentiation  as  described  till  now  is  appropriate 
for  small  to  medium  vectors  and  implicitly  assumes  'ul!  matrices,  the  class  KyperRn 
defines  “hypervectors"  composed  of  elementary  vectors  and  HyperRnxn  represents 
“hypermalrices",  which  are  sparse  matrices  with  elementary  matrices  as  elements. 
HyperRns  are  used  in  the  formation  of  product  spaces  from  elementary  vector  func¬ 
tions  as  m 
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HyperRfi  q; 

q. append  (z) ; 

q. append  (y); 

but  are  also  generated  as  the  gradient  of  scalar  functions  with  respect  to  a  HyperRn 
as  m 

RIH  a  «  . . ; 

HyperRnJe  da.z  ■  a.d  (q); 

Similarly,  HyperRftzns  may  be  manually  constructed  but  are  more  often  created 
automatically  as  the  derivative  of  an  HyperRn  with  respect  to  another  HyperRn  as  in 

HyperRn  f; 

f. append  (a); 

f. append  (b); 

HyperRaznft  df.q  »  i.d  (q);; 

These  operations  are  the  basts  for  the  assembly  of  multibody  systems  from  their 
components  (see  Section  6) 

It  is  interesting  to  compare  this  object-onented  implementation  of  basic  mathe¬ 
matical  operations  with  programming  environments  for  numenco/  mathematics  such 
as  Matlab  or  MATRlXx  systems  for  symbolical  mathematics  like  Mathematica 
and  Maple.  Clearly,  the  toolkit  implemented  here  does  not  attain  the  power  of 
these  commerical  programs  in  most  areas,  but  the  peculiar  combibatioo  of  symbol¬ 
ical  and  numerical  operations  is  particularly  suited  to  multibody  system  analysis 
Thus,  the  ability  to  form  partial  derivatives  and  easily  create  composite  vectors  and 
matrices  is  required  for  the  assembly  of  multibody  systems  and  the  combination  of 
common  subexpression  elimination  with  value  caching  to  enable  efficient  numerical 
evaluation  was  motivated  by  well-known  algorithms  to  compute  generalized  forces 
and  Jacobians. 

A  further  benefit  of  this  synthesis  of  symbolical  and  numerical  mathematics  be¬ 
comes  obvious  in  the  object-oriented  model  of  numencaf  solution  procedures  adopted 
here:  a  numerical  solution  procedure  or  “solver”  is  considered  to  be  a  constraint  on 
an  existing  independent  vector,  and  forces  this  vector  to  behave  as  the  solution  func¬ 
tion  of  some  numencal  problem.  An  abstract  base  class  RnSolver  implements  the 
basic  mechanism  involving  close  cooperation  between  the  sol/er  object  and  the  solu¬ 
tion  vector,  and  a  '‘solver  class”  denved  from  RnSolver  defines  a  particular  solution 
method  for  a  certain  numerical  problem.  For  instance,  the  solution  of  nonlinear  equa¬ 
tions  by  Newton’s  method  is  implemented  in  the  class  RnNevton  and  the  solution  of 
equations  f  »  0  for  the  vector  q  may  be  declared  with 

RnNevton  q.solver  (q,  f). 

The  solver  object  q-solver  cannot  be  manipulated  or  accessed  m  any  way,  but 
IS  Icag  as  It  exists  the  actual  iterative  process  to  form  the  solution  m  q  will  be 
mtomatically  activated  whenever  q  is  evaluated,  e  g.  when  we  print  it  with 


m 


cout  «  q» 


A  modified  form  of  value  caching  ts  implemented  to  recompute  the  solution  only 
when  some  parameter  influencing  f  changes.  In  addition,  one  may  formulate  the 
sensitivity  cr  the  solution  with  respect  to  such  a  parameter  by  differentiating  the 
constrained  vector  q.  Numerical  procedures  implemented  in  this  style  include  the 
solution  of  linear  equations  and  numencal  integration  of  ordinary  differential  equa¬ 
tions  and  differential-algebraic  equations. 


5  Elements  of  multibody  systems 

In  the  following  subsections  the  formulation  of  various  components  of  multibody 
systems  based  on  the  mathematical  operations  introduced  in  the  previous  section 
will  be  described.  First,  state  variables  are  introduced,  which  are  used  in  kinematie 
elements  to  formulate  kinematical  quantities  such  as  the  motion  of  reference  frames. 
Based  on  the  kinematics,  dynamic  elements  formulate  the  virtual  work  of  various 
kinds  of  forces  and  constraints  formulate  constraint  equations. 

5.1  State  variables 

State  variables  represent  generalized  coordinates  that  determine  the  state  of  a  multi¬ 
body  system.  They  consist  of  the  following  components:  position  variables  p,  veloc¬ 
ity  variables  v,  their  time  derivatives  p  and  tr,  virtual  displacements  Sp  and  velocity 
functions  p"{p,v),  v'iptP)  to  transform  between  p  and  v.  In  the  following,  we  will 
use  the  symbol  q  for  such  state  variables. 

Distinguishing  between  position  and  velocity  variables  simplifies  the  definition 
of  state  variables  to  describe  rotations,  as  we  can  use  any  parametrization  (e.g. 
Euler-parameters)  for  the  position  variables  while  using  angular  velocity  for  the 
velocity  variablec.  In  this  case  a  transformation  is  required  between  angular  velocity 
and  the  time  derivatives  of  the  Euler-parameters  and  for  this  reason  the  velocity 
functions  p'  and  v'  are  introduced.  The  virtual  displacements  6p  are  required  for 
the  formulation  of  virtual  work  in  dynamic  elements  and  are  independent  vectors  in 
the  same  space  as  the  velocity  variables.  Thus,  e.g.  the  virtual  displacement  of  a  state 
variable  describing  a  finite  rotation  is  a  differential  rotation  vector  corresponding  to 
the  angular  velocity. 

The  implementation  of  state  vanables  is  straightforward:  the  class  State  has 
components  for  p,  u,  p,  v,  ^p,  p'  and  v\  but  to  support  composition  of  state 
variables,  these  components  are  KyparKns,  which  must  be  assembled  by  subclasses 
of  State.  Composition  of  state  variables  is  implemented  in  State  in  the  obvious 
way  as  concatenation  of  the  KypezRn  components. 
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5.2  Kinematic  elements 


State  variables  are  used  io  Jdttemaltc  demtais  to  formulate  functioos  describio^ 
the  motion  of  the  multibody  3>‘stem.  A  ceotial  role  is  played  by  rigid-hody  motion 
between  refcrtncc  frames.  Within  the  present  approach,  a  reference  frame  (or  simply 
‘^ame")  is  directly  identified  with  a  ripd>body  motion.  This  motion  may  be  rdatit'e 
to  an  inertial  reference  frame  or  any  other  reference  frame,  so  that  ft  may  describe 
an  absolute  cr  relative  motion,  depending  on  the  context.  The  ripd  body  motion 
is  described  as  usual  hv  a  translation  r  and  a  rotation  A,  translational  and  angular 
velocity  v  and  u  and  translational  and  angular  acceleration  a  and  a,  further,  we 
introduce  translational  and  angular  virtual  displacements  Sr  and  SR.  It  is  assumed 
that  all  these  vectors  are  represented  io  some  unspecified  global  coordinate  system, 
but  we  also  consider  a  local  or  body>fixed  coordinate  s>'stem  rotated  by  the  framers 
rotation  R  and  sometimes  use  representations  io  this  coordinate  ^tem. 

A  frame  is  represented  by  the  class  Fraaa  which  stores  a  reference  to  an  Baxn  for 
R  and  references  to  !lns  corresponding  to  r.  o,  u.  a,  Sr  and  SR  represented  io  the 
global  and  body-fbeed  coordinate  system.  Fraaa  defines  ‘^multiplication^  of  Francs 
for  the  result  of  two  successive  motions  and  “transposition'*  for  reversed  motions. 
For  given  Francs  X.1  and  X..2  we  could  thus  write 

Franc  X.3  ■  X.l  •  X.2;  //  X.2  followed  by  X.l 

Franc  X.4  ■  'X.l;  //  Inverse  of  X.1 

While  frames  represent  rigid^body  motions  in  their  most  genera!  fort.),  it  is  gener* 
ally  more  convenient  to  form  rigid-body  motions  from  specialized  elementary  frames 
which  formulate  subgroups  of  rigid-body  motion  in  terms  of  joint  coordinates.  Such 
elementary  frames  will  be  callea  “links”  and  am  represented  by  subclasses  of  Franc 
such  as  RcvLink  for  the  rotation  about  an  aids  and  PrisnLxnk  for  the  translation 
along  an  axis. 

While  neither  frames  nor  links  are  associated  with  any  state  variable,  a  ’‘joint” 
IS  considered  here  to  be  a  link  with  an  assodated  state  variable  used  as  joint  coordi¬ 
nate.  Thus,  e.g.  a  RcvJoint  derived  from  a  RcvLxnk  includes  a  state  variable  of  the 
dimension  1  and  Node  which  is  directly  d^ved  from  Franc  uses  a  state  vanable  of 
dimension  6  to  formulate  a  general  rigid-body  motion. 

5.3  Dynamic  elements 

Dynamic  dements  are  those  components  of  a  multibody  system  which  generate  ap¬ 
plied  forces.  In  the  present  approach  we  demand  that  dynamic  elements  actually 
formulate  a  virtual  work  SIV  as  a  real-vidued  functional.  This  not  only  enables  the 
projection  of  applied  forces  onto  generalized  forms  in  a  simple  manner  (see  Section 
6)  but  also  accomodates  non-standard  types  of  forces  such  as  stress  measures  Typ¬ 
ically,  formulation  of  virtual  work  will  make  use  of  kinematic  elements  such  as  the 


frame  of  the  centre  of  mass  of  a  ripd  body  the  &ames  of  the  ends  of  a  beam  e!e> 
meot.  The  virtuai  uork  will  also  generally  involve  parameters  specific  to  the  dynamic 
dement  sudt  as  the  mass  and  inertia  tensor  of  a  ripd  body. 

The  dass  Dynanic  is  the  base  dass  for  representations  of  dynamic  elements.  It 
stores  references  to  P.ls  for  the  drtual  woric  SIV  and  for  kinetic  and  potential  energy 
fC  and  O’,  whidi  are  provided  for  diagnostic  purposes.  Simple  subclasses  cf  Oynaaic 
are  Force  and  Torque  for  a  riogle  applied  f(»ce  and  torque.  RigidBedy  for  rigid 
bodies.  LinSpring  and  LinTorsicn  for  translational  a.id  rotational  spring-damper 
actuators.  More  complex  classes  are  Beaa  lor  a  nonlinear  beam  dement  based  on 
[Simo,  1985]  and  SnperEleeent  for  a  superdement  comparable  to  those  described 
in  [Cardona  and  Geradin.  1991}.  The  implementation  of  Beaa  will  be  presented  in 
the  oral  presentation  to  illustrate  the  ease  with  which  new  dynamic  dements  can  be 
introduced. 


5.4  Constraints 

The  joints  of  a  multibody  system  may  also  be  modelled  as  constntnis.  This  is  nec¬ 
essary  when  the  system  contdns  kinematical  loops,  but  may  even  be  beneficial  for 
systems  without  loops,  to  reduce  the  coupling  within  the  system  model  (see  Sec¬ 
tion  6).  Constraints  place  restrictions  on  state  variables  by  formulating  eonstratnl 
functions  which  have  to  be  zero.  The  constraint  functions  consist  of  position  con- 
straiot  functions  g,  velocity  coostraint  functions  acceleration  constraint  functions 
g  and  virtual  displacement  constraint  functions  Sg  and  are  generally  formulated 
with  respect  to  two  reference  frames.  A  Lagraoge-multiplier  A  is  associated  with 
each  constraint  and  a  virtual  work  of  the  constraint  forces  is  formulated  as  “’Sg  ■  X 
In  the  following  we  will  write  g  for  the  position  constraint  function  or  the  whole 
constraint,  depending  on  context. 

The  components  of  Constraint  must  be  assembled  in  subclasses  and  such  sub¬ 
classes  of  Constraint  have  been  defined  for  all  standard  joint  types.  These  subclasses 
include  elementary  constraints  such  as  SpberConstraint  for  spherical  joints  as  well 
as  composite  constraints  such  as  RevConstraint.  which  models  the  constraints  of 
a  revoiute  joint  by  composition  of  a  SpberConstraint  and  two  DotConstraints 
(see  e  g.  [Nikravesh,  1987]).  For  this  purpose.  Constraint  defines  a  composition  of 
constraints  similar  to  the  composition  of  States. 

In  most  cases,  constraints  will  be  used  to  take  into  account  kinematical  loops, 
but  in  some  cases  it  is  possible  to  solve  such  loop-closure  constraints  for  the  joint- 
coordinates  of  particular  joints  in  the  loop.  Several  such  closed-form  solutions,  based 
on  the  method  of  [Woernle,  1988),  have  been  implemented  here  in  the  form  of  spe¬ 
cial  links.  These  “solver  links”  may  be  viewed  as  kinematically  driven  joints,  the 
jomt-coordmates  being  driven  in  such  a  way  that  the  loop-closure  constraints  are 
identically  satisfied.  E.g.  a  LengthR^vSolvor  is  a  kind  of  revoiute  joint  dnven  in 
such  a  way  that  a  length-constraint  satisfied. 
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6  Assembly  of  multibody  systems 

A  multibody  system  is  considered  to  h&ve  its  own  st^  variables  virtual  work  S\V 
and  constraint  g.  Thus,  a  multibody  system  is  treated  as  a  combination  of  state 
variables,  dynamic  elements  and  constraints  and  in  fact  the  class  Systea  is  derived 
from  State,  Dynaaic  and  Constraint.  The  multibody  system  is  thought  to  start 
out  empty,  without  state  variables  or  constraints,  and  a  zero  virtual  work.  One  then 
adds  state  variables  (which  are  appended  to  9),  dynamic  elements  (which  are  added 
to  SW)  and  constraints  (which  are  ^pended  to  g  and  added  to  6W).  In  the  class 
Systea  these  operations  are  easily  defined  in  terms  of  the  composition  operations 
already  defined  in  State,  Dynaaic  and  Constraint. 

The  main  purpose  of  Systea  is  to  formulate  various  vector  and  matrix  functions 
required  by  analysis  procedures.  The  most  important  of  these  are  the  generalized 
forces,  now  termed  /.  Tbdr  forroulatioo  is  based  on  the  fact  that  the  virtual  work 
61V  is  known  to  be  a  linear  functional  of  the  form 


^W'(«,ti,j),A,op)  =  /(t»,»,p,A)  •  6p. 


(I) 


While  the  generalized  forces  /  in  this  functional  are  not  available  m  explicit  form, 
they  can  be  easily  extracted  with  the  help  of  the  following  partial  differentiation: 


dSW 

dsp 


(2) 


Within  Systea  this  operation  is  performed  by  symbolic  differentiation  of  the  R1 
SW  with  respect  to  the  KyperRn  Sp  and  by  virtue  of  the  optimizations  implemented 
in  expression  formation,  the  resulting  KyperRn  /  will  allow  efficient  numencai  evab 
nation  for  toy  kind  of  state  variable. 

The  generalized  forces  /  depend  on  the  acceleration  v,  velocity  v,  position  p, 
and,  if  the  luuUibody  system  model  contains  constraints,  the  Lagrange-multiphers 
A.  Various  analysis  procedures  require  partial  derivatives  of  the  generalized  forces, 
and  Systea  formulates  the  mass  matnx  M,  damping  matrix  D  and  stiffness  matrix 
K  as  HyperRazns  by  symbolic  differentiation  of  /  according  to 


n-K 

dv'  dv'  dp' 


(3) 


Similarly,  the  Jacobian  matnce  of  the  constraint  «)uatioDS  arc  required.  Here  we 
assume  that 

dv  dv  dSp 

and  therefore  System  formulates  only 


(4) 


r  r 
^  dp'  ”  dv 


(5) 
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Finally,  partial  dcii\*atives  of  the  velodty  functions  (see  Section  5.1) 


P  = 


dp' 
dv  * 


V 


dp 


(6) 


are  provided. 

Ad  important  feature  of  the  current  approach  is  that  the  formulation  of  gener¬ 
alized  forces  and  other  functions  required  by  analysis  procedures  (see  Equation  (2) 
to  Equation  (6))  is  independent  of  the  type  of  coordinates  used,  once  the  multi- 
body  system  has  been  assembled.  Note  also  that  many  of  the  quantities  formulated 
here  are  not  av^labte  in  existing  approaches,  e.g.  the  stiifhess  and  damping  matri¬ 
ces  are  almost  never  avdlable  in  closed  form  in  the  current  implementations  of  the 
joint-coordinate  approach 

For  a  given  mechanical  system,  assembly  of  a  multibody  system  model  within 
the  present  approach  actually  proceeds  in  several  steps. 


1  Definition  of  links  and  joints.  Most  state  variables  will  also  be  created  in  this 
step  as  part  of  joints  or  nodes. 

2.  Formulation  of  the  kinematica!  structure,  if  necessary,  by  constructing  fiames 
from  chains  of  links  or  joints.  If  a  closed-form  solution  of  loops  to  be  at¬ 
tempted,  It  has  to  be  formulated  at  this  stage. 

3.  Dchnitioo  of  constraints  on  the  kioematical  structure. 

4.  Deiimtion  of  dynamic  elements  based  on  the  kinematical  structure. 

5.  Addition  of  selected  state  vanables,  dynamic  elements  and  constraints  to  the 
multibody  system  model. 

In  general,  considerable  freedom  exists  in  the  first  three  steps,  which  define  the 
kinematics  On  the  other  hand,  the  definition  of  dynamic  elements  is  generally  in¬ 
dependent  of  the  coordinates  used.  By  adopting  a  suitable  strategy  for  defining 
kinematics  it  is  possible  to  arrive  at  models  with  different  kinds  of  coordinates  cor¬ 
responding  to  the  well-known  multibody  form^isms  mentioned  in  Section  2.  This  is 
briefly  described  in  the  following: 


Absolute  coordinates:  For  each  body  we  introduce  a  Node  which  describes  a  gen¬ 
eral  rigid-body  motion  with  six  degrees  of  freedom,  but  all  joints  are  modelled 
as  constraints  After  adding  all  the  nodes  and  constraints  to  the  muitibody 
system,  the  system  will  have  a  large  number  of  coordinates  and  constraints 
On  the  other  hand,  the  system  matrices  will  be  quite  sparse,  and  this  sparsity 
is  preserved  in  the  HyperRmxns  formulated  here  for  the  system  matrices. 
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Joint  coordinates:  We  must  analyze  the  system  topology  to  detect  loops  and  par¬ 
tition  the  joints  into  “tree  joints’*  and  **cut  joints*’ .  The  tree  joints  are  modelled 
with  joint  classes  whereas  the  cut  joints  ^e  modelled  as  constraints.  The  joints 
and  constr^nts  are  added  to  the  system  which  will  have  a  medium  number  of 
coordinates  and  constraints  (if  there  were  any  loops). 

Minimal  coordinates:  We  must  again  det^t  kinematical  loops,  but  now  we  must 
partition  the  joints  in  each  loop  into  "independent  joints”  and  ‘‘dependent 
joints”.  The  independent  joints  are  modelled  with  joint  classes  while  the  de¬ 
pendent  joints  are  represented  by  solver  links  encapsulating  closed-form  solu¬ 
tions  of  the  loop-closure  constrsunts.  Only  the  independent  joints  are  ii.cluded 
in  the  multibody  system  model,  so  that  the  number  of  coordinates  is  minimal. 

Apart  from  these  basic  strategies,  combinations  are  also  possible,  e.g  we  might 
want  to  solve  certain  loops  in  closed  from,  but  selectively  use  constraints  elsewhere 
to  uncouple  the  system 

As  an  example,  consider  the  simple  four-bar  mechanism  of  Figure  1 ,  which  is  now 
to  be  modelled  according  to  the  strategies  outlined  above.  In  each  case,  the  model 
will  consist  of  declarations  of  Q++  objects  from  the  classes  introduced  in  this  section 
and  the  previous  st'Ct’ons.  In  particular,  heavy  use  will  be  made  of  expressions  of 
Frames  (see  Section  S.2)  to  formulate  kinematic  chains.  An  inertial  reference  frame 
and  certain  links  corresponding  to  rigid  connections  will  be  used  in  all  cases  and  are 
declared  first: 

Frame  X.O;  //  Inertial  reference  frame 

PrismLink  d  (2,  S.O);  //  Translate  along  z'axis  by  5.0  » 

PrismLink  a  (0,,  10.0):  //  Translate  along  z-azis  by  10.0  n 
PrismLink  b  (1,  '■10.0);_ 

PrismLink  c  (2,  2.0), 

R  t. length  >  14.456832;  //  The  length  of  the  coupler 
PrismLink  t  (0,  ^t. length); 
rrismLink  balf.t  (0,  -O.S^t.length);; 


Four-bar  with  absolute  coordinates:  We  declare  nodes  for  each  of  the  three 
moving  bodies,  and  then  formulate  constraints  for  the  four  joints  with  the  following 
code 

Node  N.l;  //  Bottom  of  d 
Node  N.2;  //  Bottom  of  c 
Node  N_3;  //  Right  end  of  t 

Frame  X.m  ■  N.3  •  half.t;  //  Centro  of  t 
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R«vCoa8traxnt  R,1  (X.O,  N.l,  0); 

PrismCoastraint  P.2  (X.O  ♦  a  •  b,  N_2,  1); 

UnivConstraint  U,3  (N.2  •  c,  N_3,  I,  2); 

SpharCoastraant  S_4  (N.3  •  t,,  N.l  •  d); 

System  system; 
system. add  (N.l); 
system. add  (N.2); 

system. add  (N.3);;  ^ 

system. add  (R.l);,  * 

system. add  (P_2);^ 
system. add  (U.3);, 

system. add  (S.4) ;  -i 

Four-bar  with  joint  coordinates:  We  cut  the  loop  at  the  spherical  joint  Sa^ 

which  IS  modelled  as  a  constraint,  and  declare  Ai,  Pj  and  Vz  as  joints  in  the  following  ^ 

manner:  \ 

) 


RevJoiat  R.l  (0)  ;• 


PrisaJoiat  P_2  (1), 

UnivJoint  U.3  (l.  2);, 

Fraae  X.3  *  X,0  ♦  a  •  b  *  P.2  •  c  •  0.3;  //  Right  end  of  t 
Frame  X.n  ■  X_3  *  half.t; 

SpherConetrairt  S.4  (X.O  •  R_1  •  d,^  X_3  •  t),- 

System  system; 
system. add  (R.l)>^ 
system. add  (P.2), 
system. add  (U.3);, 
system. add  (S.4); 

Four^bar  with  minimal  coordinates:  We  again  cut  the  loop  at  5^,  but  the  loop> 
closure  constraint  is  decomposed  into  a  length>constramt  and  a  parallel-constraint 
by  considering  the  characteristic  pair  54  —  (/s  as  described  m  [Woernle,  1988]  The 
length  constraint  is  solved  to  determine  the  translation  within  the  prismatic  joint 
P}  and  the  parallel-constraint  is  solved  to  determine  the  angles  within  the  universal 
joint  C/3.  Therefore,  only  Ai  is  declared  as  an  independent  joint,  while  solver  links 
are  formulated  for  P3  and  C/3  using  additional  trains  of  links. 

RsvJoint  R.l  (0); 

Frame  X.l  ■  *b  *  *a  •  R.l  •  d;  //  Left  half  of  bottom  segment 
LengthPrasmSolver  P.2  (X.l,  c,  t,,  1,^  true); 

Frame  X.b  ■  'c  *  “P.2  •  X.l;-  //  Bottom  segment 
ParUnivSolvar  U_3  (X.r,  t,  1,,  2); 

Frame  X.m  •  X.O  •  a  *  b  *  P.2  •  c  *  U_3  •  half.t;- 

System  system; 
system. add  (R.l); 

For  the  sake  of  simplicity  only  one  dynamic  clement,  a  concentrated  mass  at¬ 
tached  to  the  centre  of  the  coupler,  is  consw-red.  It  was  ignored  in  the  model? 
above,  but  a  frame  was  formulated  for  the  centre  of  mass  In  all  cases  the 
four-bar  can  be  completed  in  the  following  manner 

m  ■  10. 0; 

I  ■  m*t_length*t. length/12.0, 
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PrismLink  g  (2,  0.0,  0.0,  9.81);  //  Gr&vitational  acceleration 

RigidBody  bocy  (X^n,  g,  10.0),; 

body. 1(1,1)  ■  body  1(2,2)  •  I;, 

systen.add  (body); 

At  this  stage,  the  models  the  four-bar  axe  complete  and  analysis  procedures 
can  be  applied  to  them,  as  will  be  sho.fn  in  the  following  section.  While  the  dec¬ 
laration  of  the  models  is  quite  simple  and  intuitive,  it  is  important  to  realize  that 
the  declarations  are  fragments  of  C++  code  that  could  be  compiled  and  linked  to 
executable  programs. 

7  Analysis  of  multibody  systems 

Var.ous  analysis  procedures  can  be  applied  to  the  models  of  multibody  systems  as¬ 
sembled  in  the  previous  section.  The  implementation  of  the  analysis  procedures  is  in 
the  form  of  '‘multibody  solver  classes”  derived  from  general  solver  classes  introduced 
m  Section  4,  which  implement  general  numerical  solution  procedures.  A  multibody 
sc)v«‘r  specializes  a  general  solver  by  applying  the  solution  procedure  to  equations 
formulated  from  a  Systen  object  as  described  in  the  previous  section. 

Consider  forward  dynamic  analysis  as  implemented  in  the  class  DynaatcSolvar. 
[a  forward  dynamic  analysis  we  solve  the  equations 

-/  =  0,  {7a) 

ff  =  0,  (7b) 

for  the  acceleration  v  and  A,  where  /  and  «r  are  affine  mappings  of  v  and  A  which 
have  the  form 

-/  =  Mv  +  GlX-f,  (8a) 

g  =  G.w-7-  {8b) 

Taking  into  account  Equation  ($),  Equation  (7)  actually  has  the  form  of  a  linear 
constrained  minimization  problem  and  OynaaicSolver  is  derived  from  a  general 
solver  for  this  kind  of  problem,  passing  it  v.  A,  — g,  M  and  Gv 

To  apply  OynaaicSolver  to  any  of  the  models  of  the  previous  sections  we  declare 
the  solver  as 

DysamrcSolver  dynamic. solver  (system); 

As  explained  in  Section  4,  the  solution  vector,  consisting  of  v  and  A,  now  behaves 
as  a  function  of  any  other  arguments  of  /  and  g,  c  g.  the  position  and  velocity 
variables  p  and  v.  Thus,  to  compute  accelerations  for  various  states,  in  the  simplest 
case  we  could  use  code  like 
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for  ,(...) 

< 

systen.q.p  »  .  ;  //  Set  th«  state 

cout  «  ^7at•m.qd.v,  //  Print  the  accelerations 

} 

Other  muit>'''jo<iy  solver  classes  impleriented  in  this  style  are  KinesaticSolver 
for  kinematic  atialysis,  Stat  icSolver  for  static  equilibnum  and  kinetostatic  analysis, 
and  OOEIntegrator  or  DAElntegrator  for  Lumerical  integration  as  described  in 
[Anantharam^n  and  Hiller,  1991). 

An  impor'.ant  feature  of  these  multibody  solver  classes  is  that  under  certun  cir¬ 
cumstances  t  hey  can  be  combined.  Thus,  suppose  we  wish  to  do  forward  dynamic 
analysis  of  the  four-bar  with  joint-coordinates,  but  wish  to  perform  a  coordinate  par¬ 
titioning  in  which  the  joint-coordinates  of  the  P-i  and  are  numtncally  expressed 
m  terms  of  the  joint  coordinate  of  R\  For  this  purpose  we  first  assemble  an  aux¬ 
iliary  multibody  system  containing  Fj,  and  the  constraini  for  ^4  and  apply  a 
KinaaaticSolver  to  it  as  follows 

System  aoz.systsm; 
aux.systss.add  (P.2);, 
aux.systsa.add  (U.3); 
aux.systcm.add  (S.4);, 

KinematicSolver  kinsmatic.solver  (aux.systsm) 

As  a  result,  the  jomt-coordinates  of  P3  jmd  now  for  all  purposes  behave  as 
functions  of  the  joint-coordinate  of  R\  and  the  constraint  for  54  is  identically  satisfied. 
Therefore,  we  formulate  the  final  multibody  system  from  the  rigid  body  and  A}  only 
and  apply  a  OynanicSolver  to  it  as  followrs 

System  system; 
system. add  (body);, 
system. add  (R.l); 

Dynam:.cSolver  dynamic.solver  (system);, 

for  (...) 

< 

system. q.p  •  .  :  //  Set  the  state 

cout  «  system. qd.v;  //  Print  the  independent  accelerations 
cout  «  aux. system. qd.v;  //  Print  the  dependent  accelerations 

} 

Effectively,  we  have  obtained  a  system  with  minimal  coordinates  using  the  same 
components  from  which  we  previously  assembled  a  system  with  redundant  coordi¬ 
nates 
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8  Conclusion 


An  attempt  has  been  made  to  combine  various  existing  methods  for  the  analysts 
of  multibody  systems  within  an  object-oriented  programming  environment.  The 
resulting  C++  toolkit  can  be  used  to  quickly  generate  simulation  programs  and  to 
experiment  with  various  types  of  coordinates  and  methodologies.  It  can  also  be 
easily  extended  with  new  components  or  new  ansdysis  procedures. 

Abstractions  of  the  various  components  of  multibody  systems  are  implemented 
within  the  toolkit  as  C++  classes.  With  these  classes  it  is  possible  to  model  a 
multibody  system  in  a  simple  and  intuitive  manner;  frames,  links  and  joints  are 
declared  to  describe  the  kinematical  structure,  constraints  can  bs  used  to  restnet 
motion  and  dynamic  elements  are  introduce  to  represent  applied  forces  by  their 
virtual  work.  A  multibody  system  is  assembled  from  such  components  and  various 
analysis  procedures  can  be  applied  to  it  with  just  a  few  program  statements.  By 
adopting  different  strategies  of  modelling  the  kinematics  and  using  different  types 
of  ccordinates,  one  can  apply  either  the  absolute-coordinate,  joint-coordinate,  or 
minimal-coordinate  approach  to  the  same  multibody  system. 

An  important  feature  of  the  implementation  is  the  combination  of  symbolical  and 
numerical  computations  in  a  set  of  classes  for  mathematical  operations.  The  symbolic 
operations  greatly  simplify  the  formulation  of  the  highe^level  classes  for  components 
of  the  muUibody  system,  and  allow  operations  on  the  complete  multibody  system  to 
be  performed  in  the  same  way  for  all  types  of  coordinates.  Thus  generalized  forces 
are  formulated  by  symbolic  differentiation  of  the  virtual  work  with  respect  to  virtual 
displacements  and  symbolic  differentiation  is  also  used  to  automatically  formulate 
the  system  matrices  m  sparse  form.  On  the  other  hand,  by  using  techniques  such  as 
expression  simplification,  common  subexpression  elimination  and  value-caching  one 
automatically  obtains  numerical  efBciency  comparable  to  that  achieved  by  specialized 
algorithms  used  otherwise. 
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NON.RECURSIVE  METHODS  FOR  THE  SOLUTION  OF  THE  INVERSE  DYNAMICS 
OF  FLEXIBLE  MULTIBODY  SYSTEMS 
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Depanment  of  Mechamcal  Engiiuering 
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Sansa  Barbara,  California  93106 


abstract.  Thil  paper  addfeaaia  the  problem  of  end-potat  mjecnry  tracking  m  flexible  mulnbody 
tenu  through  the  use  of  inverse  dynamics.  A  global  Lagnnguui  approach  u  employed  m  fotmulaimg  the 
system  equaaoni  of  moooo,  and  an  uenave  procedure  is  proposed  to  acbieve  ead-p^  trajectory  vackmg 
in  three-dimensional,  flexible  muUibody  systems.  Each  iientioo  iavolvea  fintly,  a  recumve  inverse 
Unemsocs  procedure  wherem  elasiie  di^lacemenu  ue  dettrmmed  m  turns  of  the  ngid  body  coordinates 
and  Lagrange  mulupliers,  secondly,  an  explicit  compuiaiioo  of  die  inverse  dynnnuc  jouu  actaanoo.  and 
thirdly,  a  non-recursive  forward  dynamic  analyw  wherem  genenlued  cooobnnies  and  Lag^ge  multi* 
plien  are  deiermmed  in  terms  of  die  joins  actouion  and  desM  end-poira  coordmatea.  In  contrast  with  the 
recursive  methods  previoualy  piopoa^  this  new  method  is  the  moat  general  since  it  is  suuabie  for  both 
open<ham  and  closedkham  cofiflgnradoaa  of  threcxlr’iensioittl  mulnbody  systems.  The  algonifam  yields 
stable,  non<ausal  actoatmf  joint  torqoea  ami  associated  Lagrange  nmltipUen  that  account  for  the  con* 
straint  fortxs  between  flexible  moUibody  coopooems. 


1.  Introduction 

Tlie  effect  of  elastic  deformatton  on  the  dynamics  of  mulhbody  systems  has  been  vigorously  stu* 
died  dunng  the  past  thirty  years.  In  particular,  the  modeling  of  taultibody  components  as  elastic 
beams  has  received  considerable  snention  as  miAa  evident  in  the  survey  papers  of  Lowen  and 
Jandrastis,^  Erdman  and  Sandor,^  Modi,^  vid  more  recently  by  Lowen  nd  Oiassapis.*  A  speafic 
area  of  interest  with  regards  to  flexible  multibody  systems.  especUUy  in  the  aerospace  and  robot* 
ICS  indusmes.  is  in  controUing  the  motma  of  a  speafied  pout  in  the  mulnbody  system.  In  most 
cases,  the  control  objective  is  to  have  the  r*^*pouit  of  Uie  multibody  system  follow  a  dented  irt* 
jectory.  >'anous  feedback  control  strategies  for  the  problem  of  end-point  trajectory  tracking  have 
been  prv^posed.  and  the  survey  papers  of  Balas^  and  Book^  pniest  some  of  the  approaches 
advan^  by  the  controls  commuxuty  towards  this  probtem. 

The  problem  of  end-point  trajectory  tracking  u  flexible  mulnbody  systems  has  led  to  the 
development  of  computanonal  method  commonly  referred  D  as  inverse  dynamics.  Inveise 
dynamics  deals  with  the  problem  of  detennirung  the  joint  actuation  that  will  cause  a  specified 
contrcl  pomt  u  the  flexible  mulnbody  system  to  follow  a  desired  trajectory.  The  pioneensg  work 
of  Reference  7  on  the  trajectory  control  of  a  single  flexible  link  through  inverse  dynaimcs  showed 
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that  the  inverse  dynamic  torque  is  non-causal  widi  respea  to  the  end-poim  motion,  t  e ,  actuation 
IS  required  before  the  end-point  has  started  m  move  as  well  as  alter  the  end-point  has  sto|^. 
Moulin^  demonstrated  that  because  of  the  non-minimum  phase  character  of  the  inverse  dynamics 
for  the  trajectory  irackmg  problem,  the  only  bounded  solution  for  the  inverse  dynamic  torque  has 
to  be  non-caus^  Bayo.  er.  al  ?  extended  the  inverse  dynamics  to  planar,  multiple-link  systems 
iismg  an  iterative  ftequency  domain  aj^roach.  The  recursive  mediod  proposed  in  that  study  is 
suitable  for  planar  open-cham  systems,  but  required  mad  hoc  procedure  for  planar  closed-cham 
systems.  A  tune  domam  inverse  dynamics  mtWque  based  on  the  non-causal  impulse  response 
funcao^i  was  presented  by  Bayo  Moulln^^  for  the  single  link  system,  with  provisions  for 
extension  to  multiple  link  systems.  An  equivalent  time  domam  approa^  for  a  smgle  link  arm  was 
proposed  by  Kwon  and  Book^^  where  the  non-causality  of  the  computed  torque  was  captured  by 
^viding  the  mveise  system  into  causal  and  armcausal  pans.  Rec^y.  a  more  systematic  and 
more  general  run-recursive,  frequency  domam  method  for  the  inverse  dynamics  of  planar  multi¬ 
body  systems  was  proposed  in  Reference  12.  This  method  includes  the  constraint  forces  between 
the  mulnbody  components  m  the  equations  of  mooon.  and  the  method  is  found  suitable  for  both 
open-cham  and  do^-chain  conhgunnons  of  planar  multibody  systems,  ihe  effea  of  Conobs 
forces  and  centrifugal  forces  on  die  mverse  dynamics  of  constrained  mechanical  systems  was 
presented  by  Gofion  and  Shabana.^^ 

The  inverse  dynamics  ^roach  to  end-point  trajectory  tracking  of  open-cham  flexible  multi¬ 
body  systems  was  recently  applied  to  the  three-dimensional  problem  by  Ledesma,  et.  al  where 
a  recursive  procedure  was  proposed  to  simultaneously  tra^  a  desir^  end-point  trajectory  and 
fninitniw  motion-lnduced  vibrauoos  iirough  the  combined  use  of  lump^  mverse  dynamic 
torques  and  distnbuted  piezodectric  actuators.  The  recursive  procedure  required  a  controlled 
motor  at  each  intetmediate  rtvolute  joitt  and  three  motors  at  the  ground.  This  procedure  is  effec¬ 
tive  for  open-chain  systems,  but  it  is  net  valid  fcrdosed-cham  systems  because  in  such  systems, 
the  number  of  rcquir^  control  inpua  is  less  than  the  number  of  joints. 

In  this  p?per,  we  present  a  general  computational  approach  for  the  solution  of  the  non<ausal 
inverse  dynamics  of  three-dimensional,  flexible  mulubody  systems,  that  is  suitable  for  both 
open-cham  and  closed-chain  configurations.  With  this  wotk.  we  present  a  methodology  that  is 
suitable  for  all  multibody  systems,  rangmg  Uxsm  the  smgle  hnk  case  to  thrce-dunensional  systems 
with  general  topologies.  The  equations  of  motion  are  formulated  in  Section  2  and  an  iterative 
algonthro  is  subrequently  developed.  Simulation  results  for  open-cham  and  closed-cham 
configurations  are  presented  in  Section  3  to  demonstrate  the  validity  and  accuracy  of  the  method. 


2.  Problem  Formulation 

In  this  secaon,  we  derive  the  goveisung  equaaons  of  motion  for  a  flexible  multibody  system  by 
usmg  a  global  Lagringian  approach,  and  develop  a  solution  for  the  inverse  dynamics  proUem 
that  IS  suitable  for  both  open-cham  and  closed-chain  configuraoons.  Cniaal  to  the  success  of  the 
proposed  procedure  is  the  use  of  the  correct,  non-causal  Lagrange  multipliers  that  account  for  the 
constraint  forces  between  flexible  multibody  components.  These  Lagrange  muluphers  are  deter¬ 
mined  in  a  forward  dynamic  analysis,  which  in  turn,  require  the  unknown  mverse  dynamic  accua 
uons.  Therefore,  the  proposed  solunon  is  an  iterative  procedure  which  converges  to  the  stable, 
non-causal  mverse  dynamic  actuauons  and  the  associated  Lagrange  multipliers. 
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Fig.  1 :  A  tttree-dunenfional  flexible  muliibody  systen 


Consider  an  n-body  aexible  mulQbody  system  sucb  as  that  shown  in  Fig.  1.  A  typical  multi* 
body  component,  say  body  /.  is  shown  in  Fig.  1  along  with  the  floaong  reference  frame  associ* 
ated  with  that  body.  The  generalized  coordinates  cttisitt  of  ngid  body  coordinaiea  q;  which 
«1escnbe  the  poadon  and  oneotatum  of  the  floating  reference  frame  anodated  with  each  muld* 
body  component,  and  deformation  coordmatet  which  deacnbe  the  defomunon  of  the  flexible 
body  with  respect  to  its  floating  reference  frame.  The  rigid  body  cooidfamra  q/  consut  of  the 
CanesUn  coordinates  R*  which  descnbe  the  position  of  the  origin  of  the  floating  reference  frame 
associated  widi  body  /.  and  a  set  of  Euler  parameten  fr'  which  describe  the  orientation  of  the 
floating  frame.  The  use  of  Euler  parameters  among  several  choices  of  orientadon  coordinates  wiD 
be  explained  later  m  the  secdon  describing  da:  inverse  dynamics  solutioo  procedure.  The  defor* 
maoon  from  the  nominal  configuranoa  is  assumed  to  be  small,  lo  diat  the  diffeitm  bending  and 
toraonal  modes  are  decoupled.  For  the  sake  of  completeness,  we  summarize  in  the  following 
equations  the  basic  kmemadc  expressions  that  lead  to  the  general  equations  of  moooo  for  flexible 
mulQbody  systems.  A  more  detailed  fbimulaoon  is  found  m  Reference  15.  With  the  shove  choice 
of  coordmai^  the  posiQon  of  an  arbitrary  point?  inbodyf  is  given  by 

r'aR'+A^U*  (1) 

where  R*  is  the  locscon  of  the  ongin  of  the  body  axes  with  rtspea  to  the  inertial  frame,  u'  is  the 
location  of  point  ?  with  respect  to  the  body  axes,  and  is  the  rotanon  tnnsfoimadon  mamx 
from  ihe  body  axes  to  the  inertial  frame.  In  the  three«dinieosional  case,  the  rotation  tiansforma* 
Qon  macnx  is  given  by 


where  the  onentaaon  coordinates  are  represented  by  four  Euler  parameiers  9^  6|.  Oj,  and 
which  satisfy  the  following  ide.nQty: 


(3) 


Tlie  posi&oo  vector  with  respect  to  (be  body  axes,  u* .  on  be  deccmposed  ino 

tfsW  +  U/  (4) 

where  ii;  is  !be  positiaa  veoor  of  point  P  in  the  cndefonaed  state  with  respea  to  the  body 
andu/  is  the  deformaiiOD  vector  of  pc^P  with  lespeet  to  the  body  axes.  Tbedefonnanoo  vec* 
tor  u/  can  be  expressed  in  teiais  of  the  nodal  defonnatioos  by  «ing  z  discretxza' 

don  scheme,  henoe 


u)=tf<il  (5) 

«4ieit  N*  is  the  shape  fmctioa  matrix  and  qf  is  the  nodal  defiMmation  vector.  IXffocmatmg  Eq. 
(1)  with  le^KCt  to  tone,  we  obtam  die  following  expression  for  the  vdocity  vector  in  terms  of  the 
ngid  body  coordxnaies  and  nodal  defoimatiaQ  coordsutes:  ^ 

P  =R*  -2  A*  ff  E*  0-  +  A*  N*  4/  (6) 


where  (')  rqffesents  difierentiinon  with  respea  to  nme.  £'  is  a  matrix  that  depends  hiKaily  on 
the  Euler  parameters  and  is  9V01  by 


E‘» 


“5i  %  fj 

“ft  fp  01 

01  -01  ^ 


andu'  isa3x3skew>symmetricmamxgivenby 

0  %1 
u,  0  -«x 
— 0 


0) 


(8) 


in  which  and  ait  the  coordinates  of  the  genenc  point  P  with  respea  to  the  body  axes, 
in  the  defonn^  coofiguianoa 

Considering  the  reference  coordinates  jcJ )  as  i^neralized  coordinazes  for  the 

flexible  muldbody  system,  these  coonhn^  are  not  indqKodent  because  the  motion  of  ^xafic 
points  in  diCfeteni  bodies  ait  related  according  m  foe  type  of  mechanical  joints  that  iraerconnea 
them.  Moreover,  in  flexiUe  mechanical  systems,  foe  deformation  of  a  component  aHects  foe 
configuration  of  adjacers  components.  As  a  consequence,  foe  interdependence  of  foe  generalized 
coonlinaies  is  expressed  by  a  vector  of  kmema&c  constraint  eqira&ons.  such  as 


<t(q.O  =  0  (9) 

where  q  is  foe  total  vector  of  system  generalized  coordinates,  r  is  nme.  and  O  is  foe  vector  of 
lineaiiy  indepenoeru  holonomic  constrauu  equasons.  These  constraint  equations  can  be  fiinher 
classified  into: 


1  ngid  body  constraints  where  only  ngid  body  vanables  are  involved  in  foe  constraint  equa« 
Qon. 

2  joint  constramis  where  both  ngid  body  and  defcnnanon  coordinates  art  included  in  foe  con¬ 
straint  equation;  and 

3  iheonomic  constraints  wherein  foe  conscrami  equations  can  be  explicit  functions  of  nme  as 
well  as  generalized  coordinates 
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Hg.  2:  A  pair  of  floatde  bodies  coooeaed  by  t  sptencal  jdtt 


The  thiid  type  of  coostramt  becomes  active,  for  rttntpie.  in  ibe  case  of  impoamf  tfae  coonli> 
tmes  of  the  eod«effector  to  Mow  a  desired  trajectory.  To  Olcante  ifae  coDsoncaon  of  coofliaas 
equaQOQS,taketbecaseofasptaencal  jam  D^^coQDtcis  two  flexible  bodies  /  and  j  apomis 
P  and  shown  m  Fig.  2.  llie  dtree  copsaiint  equadons  contspavting  to  the  ccnaraux  coodi* 
ncn'iiatreqaues points?  and (2  tobeoomddeatcanbewntteaas 

[r‘  +  A‘  »>]  -  [w  +A'  114]  »0.  (10) 

We  note  dot  the  coostramt  equanco  exempliaed  by  Eq.  (10)  fonns  a  set  of  coupled  n^iny-ar 
algebruc  eqaanoos  Ui  the  ngtd  body  coonkoaies  and  defonnatioo  coonfanMes. 

Considenng  the  rigid  body  and  d^ocmatioo  coordzoaies  desaibed  above  as  genenbzed  coordi* 
nates,  and  following  standard  procedures  is  Buhibody  dynamics,  the  coostramed  equatioiis  of 
motion  become 

M(q)q  +  Cq+Kq  +  <l*JX=Q,+Q^q.^  (11) 

where  M.  C  and  K  are  the  system  mas,  damping  and  stiffness  manices,  respectively.  X  is  the 
vea'T  of  Lagrange  mulrij^rs  rtfsoaated  widi  the  constraints.  is  the  constraut  Jacobian 
matrix.  Q«  is  the  vector  of  apjAied  external  forces,  and  Qr  is  the  quadratic  velocity  vector.  Ihe 
quadranc  veloaty  vector  coot^  the  ceomfogal  forces  and  Coric^  forces  that  result  from  the 
diffeienoation  of  the  lanetic  etergy  expressiOR  with  respea  to  the  generalized  coordinaies. 
Geometnc  suffaung  due  to  tugh  rotation  rates  can  also  be  added  to  the  vector  Qt. 

11  FORWARD  DYNAMICS 

In  a  forward  dynamic  analysis,  i  e .  finding  the  resultmg  monoo  pven  the  applied  joim  forces  and 
external  forces.  Eqs  (9)  and  (11)  consnmte  a  mixed  system  of  diffciennal-alg^raic  equanons 
that  have  to  be  imegrated  simultaneously.  As  explained  m  the  next  secnoiu  the  soluoon  to  the 
inverse  dynamics  problem  requires  a  forward  dynamic  analysis  withm  an  neraoon  process.  We 
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solve  the  foiwaid  dynamics  problem  by  using  the  augmented  Lagrangian  penalty  fonnulanon 
Applying  ine  augmented  La^giac  penalty  fonnulaaon  to  Eqs.  (9)  and  0  D  results  m  the  fol- 
lowmg  equaL'oo: 

M(q)q  +  Cq  +  Kq+<l>J  a^^+2ttci)d»+(i)2<I>j  =Q,+Q,(q.q)-d>JX‘  (12) 


where  a  is  a  diagonal  matnx  of  penalty  factors  whose  elements  are  large  real  numbers  that  will 
assure  the  saiisf^on  of  constraints,  m  and  (t  are  diagonal  manices  representing  the  natural  fie- 
quenoes  and  damj^g  charactensdcs  of  the  dynarmc  penaby  system  associated  with  the  con¬ 
straints.  Values  of  a  in  the  range  ICP  <  a  <  10^  provide  excellent  results  when  woilang  in  double 
precisiorL  The  augmented  Lagrao^an  method  requires  an  iteration  for  the  correct  value  of  the 
L;^range  muldpbers.  The  iterative  equauon  for  the  Lagrange  mulnplieis  is  given  by 


«,  =  V  +  o[ 


(13) 


The  Iterative  process  described  by  £q  (13)  involves  only  a  few  additional  operauons  during  each 
Iteration  but  it  significantly  improves  the  convergence  of  dtt  forward  dynamics  soluuon  as  com¬ 
pared  to  the  staodaid  pimalty  method.*^ 

The  augmented  Lagrangian  penalty  formulation  has  several  advantages  over  the  standard  algo- 
nthms  used  m  solving  differenoal-algebraic  equations  Fust,  the  method  obviates  the  need  to 
solve  a  mixed  set  of  diffeiennal-algebraic  equanons  and  does  not  mciease  the  number  of  equa- 
oons  to  account  for  the  constraims.  Second,  this  method  allows  the  use  of  standard  uncondmon- 
ally  stable  algonthms  without  the  need  of  fonher  stabilization  techniques  to  control  the  violation 
of  constraints  during  foe  integration  process  Tlurd.  the  method  can  handle  redundant  constramts 
and  aUovbrs  the  muldbody  system  to  undergo  singular  posinons.  Fourth,  the  constraint  forces 
(Lagrange  muldpliers)  can  be  obtained  as  a  by-produa  of  the  integration  without  having  to 
integrate  addiuonal  equanons  for  them.  Finally,  the  method  assures  ccnvergence  independent  of 
the  penalty  values  used. 


2.2  l^A^E  KINEMATICS  AND  INVERSE  DYNAMICIS 

Moulin  and  Bayo  showed  that  because  of  the  non-miiumum  phase  character  of  the  inverse 
problem,  foe  unique  stable  solution  i$  found  to  be  non’Causal,  i  e .  actuation  is  required  before 
the  end-pomt  has  started  to  move  as  well  as  after  dm  end-poim  has  stopped.  These  findings  have 
beat  corroborated  by  Paden  and  Chen^^  m  their  theoretical  wodc  on  the  mversion  of  nonlinear 
non-muumum  phase  systems  such  as  flexible  mulnbodies.  In  addition,  the  faa  that  the  stable 
solution  starts  at  neganve  nme  and  extends  into  future  tune  precludes  standard  tune  domain 
mtegranon  schemes  currently  available  ui  multibody  computer  codes  from  obtaining  the  proper 
uiverse  soluuoa  These  codes  will  yield  causal  results  and  theiefore  are  valid,  ui  general,  for  the 
forward  dynamics  only.  The  mtegraaon  is  of  crucial  unponance  ui  obtaining  non-causal  solu- 
nons,  and  as  previously  demonstrated  in  the  planar  inverse  dynamics  problem,  the  nme- 
anticipatory  effect  can  be  automsQcally  obtained  by  mtegraung  m  the  frequency  domain^  or  ui 
the  time  domam  by  using  the  non-causal  impulse  response  function  and  the  bilateral  Laplace 
transform.*® 

A  previously  proposed  solution  to  the  three-dimensional  inverse  dynamics  problem*^  relied  on 
a  puined-free  finite  element  model  of  a  flexible  beam,  and  the  equauon  for  the  mverse  dynamics 
torque  was  formulated  by  imposing  the  condition  that  the  torsional  defonnanon  and  foe  two 
transverse  deformations  of  the  free  end  of  each  Unk  be  zero  throughout  the  mouon  TTus  limited 
type  of  model  led  to  a  recursive  scheme  to  solve  the  inverse  dynamics  of  flexible  muliibody 
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systems,  and  is  found  suitable  for  open-chain  configuranons  but  not  for  closed-chain 
configuiaQons  In  this  section,  we  desenbe  an  iteranve  Lagrangian  proceduit  to  solve  the  three- 
dimensional  inverse  dynamics  proUem  for  either  open-chain  or  closed-chain  topologies  Our 
overall  strategy  is  to  first  solve  the  inverse  kinematics  problem,  i  e.,  finding  the  unknown  ngid 
body  coordinates  q,  and  flexible  body  displacements  q/ .  given  the  desired  end-pomt  coordinams 
as  expliat  functicms  of  time.  Having  determined  die  correct  geneialiaed  coordinates  and  their 
time  denvanves,  the  inverse  dynamics  joint  torques  can  be  obtained  explicitly  fiom  the  equanois 
of  moQon.  Compared  to  the  recursive  procedure  oted  above,  this  new  approach  is  more  sys- 
temanc  and  becomes  the  only  choice  when  closed-diam  systems  are  encoimteied.  We  model  the 
elastic  links  under  pumed-pinned  boundary  conditions.  Furthermore,  since  torsional  defonnations 
cause  deviations  from  the  nominal  conflguruion  fimher  down  the  chain,  we  model  the  elastic  link 
as  fixed  with  respect  to  torsion  at  the  distal  end  of  the  link. 

Our  goal  then  is  to  formulate  an  reverse  kimma&cs  equanon  that  is  lineanzed  about  the  norm- 
nal  motion,  so  that  the  elastic  displacements,  whidi  are  non-causal  with  respect  to  the  end-point 
motion,  can  be  determined  throu^  a  fiequency  domain  analysis.  This  is  possible  only  if  die  lead¬ 
ing  matnx  of  the  lineanzed  equation  is  nme-mvanam  and  if  the  forcing  term  is  Founer 
transformable  This  objective  has  been  achieved  in  the  planar  case  with  the  use  of  reference  coor- 
dirutes  for  the  ngid  body  vanables  to  desenbe  the  position  and  onentanon  of  the  floanng  refer¬ 
ence  frame.^^ 

Tbt  three-dimensional  inverse  kinemaucs  problem  presents  additional  di^culties  not  found  in 
the  planar  case.  First,  unlike  the  planar  case,  the  three-dim'msional  torque  vectors  change  duec- 
Dons  in  tune,  so  that  the  external  force  vector  Q«  in  Eq  (U)  becomes  a  nonlinear  function  of  the 
ngid  body  onenunon  coordinates.  To  overcome  this  difficulty,  a  proper  panmetiization  of  the 
ngid  body  coordinates  and  proper  bases  for  the  joim  torques  are  necessary  to  attain  the  stated 
(^jecQves  re  forming  the  Imeanred  reverse  kinemaDcs  equations.  As  described  later  re  this  sec- 
non,  the  desired  form  of  die  lineanzed  inverse  kinematics  equation  is  possible  if  Euler  parameters 
are  used  to  desenbe  the  ngid  body  cnenunon  and  if  the  base  torque  vector  of  each  mulnbody 
component  it  expressed  in  terms  of  components  along  die  associated  floating  reference  frame. 

A  second  difficulty  that  ai^iean  in  dK  three-dusensional  inverse  dynamics  problem  is  that  the 
end-pomt  vibration  re  the  plane  defined  by  the  tevolute  joint  axis  and  the  member  axis  can  not  be 
controlled  by  the  torque  airbed  at  the  revtdute  joint.  This  suggests  that  additional  actuanon  is 
necessary  to  control  the  end-pomt  motion  when  the  multibody  system  reaches  an  "inaccessible* 
configuiaoon.^^  Tbis  problem  has  been  addressed  in  Reference  14  wherein  one  motor  at  each 
mtermediate  joint  and  three  motors  at  the  ground  were  proposed  to  control  the  end-point  motion 
for  all  possible  configurations  of  a  certam  dess  of  open-chain,  flexible  multibody  systems.  Ilie 
problem  of  "maccessibibty"  m  open<ham  systems,  however,  can  be  completely  avoided  simply 
through  a  judicious  design  of  the  onentation  of  the  jomt  motors  so  that  end-point  vibration  is  con¬ 
trollable  for  all  possible  configurations.  For  closed-chain  systems,  "inaccessible"  configurations 
do  not  occur,  hence  the  controllabiluy  of  the  end-point  motion  is  assured  without  the  need  for 
extra  actuanon 

Consider  again  the  system  equauonsofmouon  expressed  by  Eq  (1!)  For  a  typical  mulnbody 
component,  say  body  i ,  the  equauons  of  monon  can  be  wnnen  in  the  foUowreg  parouoned  form: 
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The  elements  of  the  mass  matru  and  quadranc  veloci^  force  vector  corresponding  to  an  iso* 
parametric,  three-dimensional  curved  beam  fimte  element  are  given  in  the  Appendix. 

Let  us  define  as  the  torque  vector  at  the  base  of  body  i .  whose  three  components  and 
X/  are  parallel  to  the  assodat^  floating  reference  axes  r*.  and  r^  respectively.  If  we  use  Euler 
parameters  as  the  rigid  body  onentanon  coordinates,  die  externally  applied  joint  forces  QJa  asso¬ 
ciated  with  the  ngid  body  rotaoon  of  body  i  can  be  expressed  as 

Qifl  =  tG'Ffx‘-(A-FA‘**t'*V  (15) 


where  x*  is  the  base  torque  acung  on  body  i  and  whose  components  are  parallel  to  the  fioaung 
reference  axes  associated  with  body  l\  x*^*  is  the  vector  of  joint  torques  and  reaction  moments 
transmitted  from  body  i  to  body  f+1.  and  whose  components  are  parallel  to  the  floating  reference 
axes  associated  with  body  i+U  A*  and  A'**  are  body  axes  to  inertial  axes  rotation  transformation 
matnces  for  bodies  i  and  /4>1.  respecuvely:  ^  is  a  mamx  that  maps  the  denvanvcs  of  the 
Euler  parameters  descnbmg  the  onentanon  of  the  reference  frame  of  body  i  to  the  angular  velo¬ 
city  of  this  reference  frame,  and  is  given  by  G^ «  2  Combining  Eq.  (15)  with  the  se  xmd  set  of 
equations  in  Eq.  (14)  yields 

(G'r  (x*  -(A'F  A‘*‘x'**^“mi?  R*  +in4«6*  +m^/  q)  +a>f  X-QJ®  (16) 

If  we  pre-multiply  both  sides  of  Eq.  (16)  by  jG*  and  use  the  idenoty 

loor^lj  (17) 

where  1)  is  the  3x  3  idenoty  matnx.  we  can  get  the  following  result  after  expanding  the  inema 
matnces  and  quadratic  velocity  vectors  found  m  Eq.  (16).  (the  reader  is  referred  to  the  Appendix 
for  the  expressions  for  the  meroa  matnces  and  quadranc  velocity  vectors  m  terms  of  the  mvan- 
ants  of  the  mo’uon): 

r  =(A‘F  V  Iti4s  R'  +J'  G'  e*  +  J/  q/  +  ^-G'  Oj  k 

+  ^G'(C‘r(j'G‘e'+j/q;;  08) 

where  is  the  3  x  3  inertia  tensor  of  body  i  with  re^ct  to  the  ongui  of  the  floating  reference 
frame  and  measured  relanve  to  this  hame.  and  J/  is  the  inema  mainx  coupling  the  ngid  body 
rotauon  and  the  elastic  defoimanon  The  l»y  to  obtaining  a  ume-mvanani  leading  matnx.  that  is 
necessary  in  transformmg  the  Uneanzed  equations  of  mouon  into  the  frequency  domain,  is  the 
fact  that  the  inemal  coupling  matnx  J/  can  be  decomposed  into  the  sum  of  a  ume-invanam 
matnx  and  a  tune-varying  matnx,  i.e . 
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J/=JA+JA  09) 

whert  J/«  and  ij,  are  the  nsie-invanant  part  and  ume*varying  pan  of  J).  respectively  This 
decomposition  is  essential  to  the  formulation  of  the  inverse  kinemaocs  equations  that  lead  to 
non-causal  solutions  to  the  nonlinear  inversion  problem.  This  is  also  the  reason  for  selecting 
Euler  parameters  as  ngid  body  onentaoon  coordinates  over  other  types  of  smgulanty-ftee  coordi* 
nates  such  as  natural  coordinates.^^  where  the  decomposition  of  the  inertial  cou^g  matnx  mto 
trnie'invanant  and  nme-varymg  parts  is  mulnpltcaove  rather  than  additive  as  in  Eq.  (19)  Intro- 
ducmg  this  decomposioon  into  (18)  results  in  the  following  expression  for  the  base  torque  on 
body/' 

T*  =  (A*  f  A'*>  r +  Ti  +  Jj,  q}  (20) 

where  Ti  is  a  torque  vector  given  by 

Ti  =  -l-G'  mil  R'  +  J'  G‘  &  +  J/,  q/  +  ^G'  Of  X 

+  -[G'tG'l''a‘G'e'+J/4/;  (21) 

Considenng  the  equanons  of  mourn  associated  with  the  elasuc  degrees  of  ^dom.  the  exter¬ 
nally  applied  force  vector  due  to  the  joint  torques  acting  on  body  i  can  be  expressed  as 

Qi/  =  N/  r  -  n;  (A*  F  A**>  T***  (22) 

where  and  N,  are  the  shape  funcoon  matnces  assoaated  with  a  totqi.e  vector  acting  on  node 
b  (base)  and  at  node  r  (tip)  of  the  finite  element  mesh,  rtspecuvely.  Combining  Eq.  (22)  with  the 
third  set  of  equaoons  in  ^  (14)  yields  the  following  inverse  kinemarics  equauons  for  body  / : 

*//  ^1/  ^  (23) 

where  die  modified  mass  matrix  is  given  by 

(24) 

and  (he  mouon-induced  force  vector  acang  on  the  elasuc  degrees  of  freedom  is  given  by 

F-  f  A‘*>  X'*>  +  -  N/CA'F  A***  V*' 

+  Qi/  -  Oj  -  mfg  R*  -  m/#  6*  (25) 

The  m  iified  mass  matnx  Ai}/  is  nonsymmetnc  and  it  is  precisely  this  nuisymmetry  that  pro¬ 
duces  elasuc  displacements  w^ch  are  non-causai  with  respea  to  the  end-pomt  motion  when 
non-causal  lechruques  m  employed  to  obtain  the  proper  inversion  of  the  nonlinear,  non- 
mimmum  phase  systems  Furthermore,  inspection  of  Eq$.(23)-(25)  shows  that  the  inverse 
kmemaucs  equauon  for  body  /  assumes  that  the  base  torque  vector  x**’  is  known  beforehand. 
This  suggests  some  forni  of  recursive  algonthm  for  the  inverse  kinsmadcs.  t  e.,  finding  the  elasuc 
displacements  startmg  from  the  end-pomt.  and  proceeding  to  the  base  of  the  mulubody  system 
(mboaid  direcnon).  This  procedure  is  straightforward  for  open-chain  configurauons.  However,  for 
closed-chain  configurauons.  we  need  to  take  the  iddiuonal  step  of  cumng  .le  chim  at  the  joini 
that  1$  defined  as  the  end-pomt.  and  then  proceed  as  m  the  open-cham  case,  since  the  constraint 
forces  at  ihe  cut  are  automaucally  accounted  for  by  die  veaor  of  Lagrange  multipliers. 

The  nonlinear  inversion  can  now  be  earned  out  efficiently  in  the  fiequency  domam  since  the 
leading  matnces  have  been  constructed  such  that  they  remam  constant  throughout  the  monon. 
Our  strategy  is  to  solve  Eq  (23)  in  the  frequency  domain  to  obtain  the  nodal  deformauon  veemr 
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<lf  ^at  IS  non-causal  with  respect  to  the  end-poim  motion.  In  the  frequency  domain.  Eq  (23)  can 
be  wnaen  as  a  set  of  complex  equations  for  a  pamcular  frequency  to 

+  4fM=H(0)  (26) 

Where  ^((o)  is  the  Founer  trensform  of  ^(r)  and  P(ci))  is  the  Founer  transform  of  F‘(r).  Eq 
(26)  IS  based  on  the  assumption  that  i^(r)  and  ^(r)  are  Founer  transformable  This  a^umpuon 
IS  valid  for  slewing  motions  which  are  from  rest  u>  rest  The  nodal  acceleracon  vector  ^(O))  can 
be  obtained  directly  from  Eq.  (26)  for  each  Aequency  to.  The  leading  matnx  of  Eq  (26)  is  a  com* 
plex  regular  matnx  that  is  invertible  for  all  frequencies  except  for  co  a  0  However,  for  o  s  o,  the 
system  undergoes  a  ngid  body  motion,  and  the  leading  matnx  will  be  determined  only  by  m// 
which  IS  positive  defimte  and  therefore  mvercble.  We  note,  however,  that  the  forcmg  vector  on 
the  nght  hand  side  of  Eq.  (26)  depends  on  iht  elastic  deformations,  velodues  and  accelerauons 
Therefore,  an  iterative  process  is  needed  to  obtain  the  solution  to  the  differential  equanons  which 
are  nonlinear  in  q/.  We  start  the  iteranon  proass  by  assummg  zero  elastic  defonnations,  veloa* 
oes  and  accelerations  for  the  initial  calculation  of  the  forcing  vector  F*  (r ),  and  use  a  successive 
substitution  scheme  to  converge  to  the  correa  solution.  Finally,  the  elastic  displacements  and 
(heir  denvadves  in  the  tune  domam  may  be  obtained  through  the  application  of  the  inverse 
Founer  transform,  e  g.. 

Alternately,  the  computaoon  of  the  elasnc  displacements  and  their  denvanves  m  each  iterauon 
can  also  be  earned  out  in  the  time  domain  through  the  use  of  the  non-causal  tmpui'.e  response 
function  and  the  bilateral  L^lace  transform,  e  g., 

(28) 

where  hy(r)  is  the  non*causal  acceleraoon  response  vector  to  an  impulse  applied  to  the  degree 
of  htedom  and  fj(t)  is  the  component  of  the  forcing  term  on  the  nght  hand  side  of  Eq.  (23) 
We  note  that  the  integranon  from  to  oo  is  necessary  to  capture  the  non>causal  effects. 

Once  the  non*cau$al  elasuc  disr^acements  and  their  denvanves  are  known.  Eq.  (IS)  can  be 
used  to  explicitly  compute  die  non-causal  mverse  dynamics  joint  efforts  that  will  move  Jie  end 
effector  according  to  a  desired  trajectory.  We  note,  however,  that  the  joint  torques  and  elastic  dis* 
placements  given  by  Eqs.  (18)  and  (23).  respectively,  depend  on  the  Lagrange  muluphers  and 
ngid  body  coordinates,  which  in  turn  depend  on  the  elas&c  dispUcemenis  and  the  applied  torque. 
Moreover,  the  ngid  body  coorduiates  and  Lagrange  muldpbcrs  are  different  from  their  nominal 
values  when  the  components  of  the  multibody  system  are  flexible.  Therefore,  a  forward  dynamic 
analysis  is  required  to  obtain  an  improved  estimate  of  the  generalized  coordinates  and  Lagrange 
multipliers.  In  order  to  ensure  that  the  iteration  process  converges  to  obtain  the  joint  efforts  that 
will  cause  the  end*effector  to  follow  the  desired  trajectory,  the  forward  dynamics  analysis  is  car* 
ned  out  with  the  addioonal  constraint  that  the  coordinates  of  the  end*point  follow  the  desired  tra¬ 
jectory.  These  addiuonal  constraints  have  corresponding  Lagrange  multipliers  which  act  as 
correcung  terms  to  the  joint  efforts  that  have  bc«t  previously  calculated 

To  summanze.  the  procedure  for  otrtaming  the  inverse  dynamics  solution  for  three- 
dimensional.  flexible  mulubody  systems  involve  the  following  steps’ 
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A]gorithm: 

1.  Perfonn  a  ngid  body  inverse  dynamic  analysis  to  obtain  the  nominal 
values  of  the  ngid  b^y  coordinates  qr  and  Lagrange  mulnphers  X. 

2  Solve  the  inverse  kmemaucs  equaaon  m  the  Irequency  domain  through 
£q  (23)  or  in  the  time  domain  through  Eq.  (28)  to  obtain  the 
time>deiayed  elastic  displacements  and  tteirtime  denvatives 

3  Compute  the  mverse  dynamics  joint  effons  t  usmg  Eq.  (1 8) 

4.  Perfonn  a  forward  dynamic  analysis  usmg  Eqs.  (12)  and  (13>  to  obtam  new 
values  for  the  generalized  coordinates  and  Lagrange  multijdiers. 

Repeat  steps  2  through  4  until  convergence  in  the  mverse  dynamics 
torques  is  achieved. 

It  is  worthwhile  to  compare  the  recursive  procedure  proposed  m  Reference  14  and  the  algo* 
nthffl  proposed  m  this  paper.  The  most  important  difference  between  the  two  methods  is  that  the 
former  method  assumes  that  the  dependence  of  rigid  body  coordinates  on  the  elasnc  displace* 
ments  are  made  negligible  through  the  action  of  control  forces  ao  that  the  rigid  body  coordinates 
take  on  values  corresponding  to  the  nominal  mouon.  Thit  assumption  is  not  made  in  the  presem 
method  and  consequiauly,  the  solution  of  the  inverse  kinematics  equation  of  Eq.  (23)  would 
require  an  iteration  for  the  ngid  body  coordinates  q^  as  well  as  the  Lagrange  multipliers  X  that 
are  needed  as  mputs  to  the  mverse  kinematics  equation.  A  consequence  of  the  above  assumpoon 
m  the  previously  proposed  recursive  procedure  is  that  control  inputs  were  required  at  all  mter* 
mediate  jomts  in  the  multibody  system.  This  requirement  is  acceptable  in  open*chain 
configuraoons.  but  not  practical  in  closed*cham  contiguratiocis  because  the  number  of  system 
degrees  of  freedom  is  less  than  the  number  of  joints  m  a  closed*cham  mulubody  system.  The 
present  procedure  takes  advantage  of  this  fact  and  allows  the  analyst  to  choose  a  pnori  which 
jomts  In  the  multibody  system  are  the  control  joints.  Therefore,  the  present  algonihm  is  more 
general  and  more  systematic  than  the  previously  proposed  procedure,  although  it  requires  more 
computaoonai  effort 


3.  Simulation  Results  and  Discussion 

We  present  m  this  secuon  some  results  of  the  numencal  unptementioon  of  the  procedure  dis* 
cussed  above.  First  we  apply  the  procedure  proposed  in  this  paper  to  the  mverse  dynamics  of  a 
twO'link,  open*€ham  flexible  mulubody  system  undergomg  motion  m  Uuee*dunen$ional  space, 
and  compare  the  results  with  those  obtamed  by  the  previously  proposed  recursive  proadure.*^ 
Next,  we  present  some  sunulation  results  of  the  applicaoon  of  ^  present  procedure  to  the 
inverse  dynamics  of  a  clo$ed*chain.  flexible  mulobt^y  system  undergomg  three'dimensional 
mouoa 

31  OPEN-CHAIN  MULTIBODY  SYSTEM 

Ihe  iteraove  procedure  discussed  in  the  precedmg  secuon  is  a^Iieo  to  the  three-dimensional 
open*cham  flexible  manipulator  shown  m  Fig  3.  The  mulubody  system  is  controlled  by  three 
motors  at  the  base  and  one  motor  at  the  intermediate  revolme  joint.  The  desired  mouon  is  to  have 
the  end-pomt  remain  in  the  plane  with  the  xj  coordinate  and  xj  coordinate  of  the  end-pomt 
following  the  trajectones  shown  in  Fig.  4  Gravnaurmal  forces  are  neglected.  Tne  two  links  share 
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Fig  5:  Open-ehiin  inverse  dyiuinic  torques:  (a)  joint  torque  (b)  joint  tonjue  Ty 


We  petfonn  two  sets  of  computations  for  the  example  consUeted:  I)  using  the  tecunive  pro¬ 
cedure  proposed  in  Reference  14;  and  2)  using  the  iteranve  picceduie  proposed  in  this  paper.  In 
the  open-chain  case,  each  intermediate  Joint  needs  to  be  conrolled.  and  we  thetefbie  expea  very 
similv  results  fttxn  both  methods.  Plots  of  Ittverse  dynamic  Joint  torques  needed  to  titcit  the 
desired  end-point  trajectory  ate  shown  in  Hgs.  5a  and  Sb.  The  teaults  obtained  from  the  two 
methods  supenmpose,  thus  validating  the  method  proposed  In  this  paper.  Plots  of  the  conespond- 
ing  rigid  body  torques  are  also  s-hown  In  the  figures  to  illustrate  the  non-causal  nature  of  the 
inverse  dynamic  rorquea  In  Figs.  5a-b,  the  dashed  curves  refer  to  the  inverse  dynamic  torques, 
while  the  solid  curves  refer  to  the  rigid  body  torques. 

3.2  CLOSED-CHAIN  MULTIBODY  SYSTCM 

Fig.  6  shows  a  closed-chain,  three-dimensionai  Sextble  muliibody  system,  where  the  selected 
control  torques  are  shown  in  the  figure.  Joints  1-4  are  revoluie  Joints  while  Jouu  5  is  a  spbencal 
joiru.  The  desiied  end-pomt  (joint  5)  trajectory  is  a  mouon  in  the  sr-xi  plane  wlrj  the  xj  coordi¬ 
nate  and  xj  coordinate  of  the  end-poiiu  following  the  mjectones  ahown  in  Fig.  7.  As  ui  the 
open-chain  case,  graviiaaonal  forces  are  not  considered  in  order  to  focus  on  die  uienial  effects  on 
die  dynamics  of  the  system.  The  four  llnics  share  the  foUowuig  geometnc  and  material  properaes: 

Length:  1.0  m 

Cross  secnoo dimensions:  I.Ocm  x  1.0 cm 
Young's  modulus:  40  CFa 
Shear  modulus:  15  GFa 
Mass  density:  2715  *g/m’ 

Tip  mass:  0.1  kg 
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Fig  8:  Gosed-ctuin  inverse  dynamic  torques:  (a)  joint  torque  Ti.  (b)  joint  torque  r  j 


The  present  procedure  is  app^ed  to  the  closed*€hain  system  by  introducing  a  cut  at  the  end* 
point  (joint  5).  thus  creating  two  open*cham  systems.  The  intern^  constraint  torces  exposed  by 
the  cut  are  automadcaUy  taken  into  account  by  the  Lagrange  multipliers  m  the  equaoons  of 
moQon.  Figs.  8a  and  8b  show  Joint  torques  Ti  and  7).  respectively,  that  are  needed  to  achieve  the 
desired  end-point  trajectory.  In  these  figures,  the  dashed  curves  refer  to  the  inverse  dynamic 
torques  obtained  by  the  present  procedure,  while  the  solid  curves  lefer  to  the  corresponding  ngid 
body  totques.  We  observe  that  pre-actuation  and  post-acma&on  with  respect  to  end-point  mooon 
are  exhibited  by  the  inverse  dynamic  torques. 


4.  Conclusion 

We  have  presented  a  new  iterative  procedure  for  determining  the  inverse  dynamic  torques  that  am 
needed  for  end-pomt  trajectory  tracking  m  three-dimensional  flexible  mulDbody  systems  An 
Iterative  procedure  is  necessary  because  of  the  interdependence  between  the  elasuc  coordinates, 
the  ngid  body  coordinates  and  the  assooated  Lagrange  mulDpUeis  m  the  system  equaoons  of 
motion.  This  procedure  is  valid  for  both  open-cham  and  closed-cham  configurations,  and  differs  ^ 

the  previously  proposed  recunive  pn^ures  in  the  sense  that  the  ngid  body  coordinates  are 
not  assumed  to  follow  the  nominal  moooa  The  conditions  for  trajectory  tnclung  are  now  met  m 
a  more  general  way  through  the  satisfaction  of  rheonomic  constraint  condinons.  The  new  method 
IS  shown  to  yield  the  same  results  as  those  obtained  with  the  recursive  procedures  for  open-chain 
systems  with  normal  link  fiexibilities  and  nonnal  rotaaon  rates.  For  closed'Chain  systems,  how-  I 

ever,  this  new  method  is  the  only  valid  pmceduie  for  deiennuung  the  inverse  dynamic  torques 
since  ui  this  case,  the  number  of  control  torques  ts  smaller  than  the  number  of  joints  and  there¬ 
fore,  the  recursive  methods  can  not  be  applied 
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Fulther  research  is  needed  to  address  the  problem  of  simultaneous  trajectory  tracking  and 
vibration  minimization  of  three-dimensional,  flexible  multibody  systems  with  general  topologies 
In  a  future  paper,  we  will  address  this  problem  through  the  use  of  redundant  actuation  in  the  foim 
of  combined  lumped  and  distnbuted  actuators. 
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The  elements  of  the  mass  matrix  and  quadranc  velocity  force  vector  m  Eq  (l4)  can  be  expressed 
in  terms  of  the  so-called  invanants  of  the  moDon  which  need  to  be  compuxd  only  once  at  the 
start  of  the  simulation.  For  each  component  of  the  flexible  multibody  system,  the  invanants  of  the 
mouon  can  be  expressed  by  the  following  integrals: 

Zi  =  |u,  prfv  (An 

Z2  =  |Np.(V  (A2) 

(u,2  +u,5)  -fe.u,, 

Zj=(  -u,,u,  pdV  (A.3) 

zyalu,,  N;prfV',  i,)-U.3  (A4) 

Zy^lNjN;  p.(V.  i.;  =  U.3  (A5) 

where  p  is  the  mass  density.  V  is  the  volume  of  the  component.  N  is  the  shape  function  mamx. 
and  Ny  is  the  y*  low  of  the  shape  function  mamx.  We  observe  that  the  motion  invanani  Z\  is  a 
measure  of  the  flrs:  moment  of  the  undeformed  component  about  the  body  axes,  and  the  motion 
invariant  Z)  is  the  inertia  tensor  of  the  undeformed  component  with  respect  to  the  body  axes 
Gosed-form  expressions  for  the  motion  invanants  correspondmg  to  the  three-dimensional. 
Bemoulli-Eulcr  straight  beam  element  arc  given  in  Reference  15.  In  this  paper,  however,  we  use 
the  vanable-node.  isoparamemc,  three-dimensional  curved  beam  element  developed  by  Bathe 
and  Bolourchi^^  to  mc^l  the  flexible  links  As  a  result,  the  motion  invanants  can  be  expressed  m 
terms  of  mtegrals  which  are  evaluated  numencaUy  through  Gaussian  quadrature 
The  components  of  the  mass  matnx.  express^  m  terms  of  the  invanants  of  the  mouon  are 
given  by  the  following 

nvy?ssml3  (A  6) 

m;?e»-ASG  (A7) 


4: 


muf  =  A  Z2 

(A  8) 

me9  =  G^  J  G  .  J  =  [Z3  +  Ji  +  J2I 

(A  9) 

me/  =  G^  J/  :  J/  =  ( j/,  +  J/,  ] 

(A  10) 

m//=Zi>  +  Z^  +  Z^3 

(All) 

Where,  in  Eq  (A  6),  m  is  the  total  mass  of  the  compoiKm.  and  the  ulde  symbol  above  the  vector 
m  Eq  (A.7)  refers  to  the  skew*symmcmc  mamx  operator  “nie  mamces  S.  J/^ ,  J/, ,  J{.  and  J2  are 
given  by 


SsZi-fZsq/ 


j/.= 


(A  12) 


(A  13) 


J/,= 


r(z?-z?=) 

r(z^<-z« 

^(Zi^-Z^) 


(A  14) 


Ji  = 


(pa+pjj)  -pij  -pij 
-P21  (PII+P3J)  -P23 
-PJI  -P32  (Plt+P22) 


(A  15) 


J2  = 


(«22+<?h)  -^12  ^  -'JH 
-421  (?l!  +  <?3l)  -?22 

-411  -432  (411  +  422) 


(A  16) 


m  which 

p.;  =(ZP  +  ZP)q/,  i,;  =  U.3  (A17) 

2nd 

4,;  sq/'Zj'q/.  I.;  =  1.2.3  (A  18) 

The  quadnuc  velocity  force  vcaots  are  given  by 

Qvr  s-Afo^S  +  ZciZa^)  (A  19) 

Q,e  =  -2G’' fJu  +  J/ 4/7  (A20) 

Q,/  =  ~  Iti’r  izl'  +zp  +  Zpf  -  («>’)■  m//  q/  - 12  »]’  ni//  qr  (A  21) 

where  (0  IS  the  absolute  angular  velocity  of  the  body  axes,  whose  coinponenis  are  expressed  wnh 
respect  to  the  body  axes  and  given  by 

M  =  Ge  (A2:) 


a 
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1 


419 


4^  rht  maoices  [^)*  and  (2  o)*  are  Kack  dagcmi  cusicss  u-hose  dugcaal  2x  ^ 

and  -1  a  respecm-cly. 
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ABSTRACT  A  multilevel  approach  to  syothe&isof  plafitr  mechanisms  is  presented.  The  approach  covers 
both  structural  and  dimensional  synthesis  of  planar  ngid  body  mechanisms  coDtatning  revolute  and 
translaiionai  jomts  The  synthesis  is  based  on  four  different  cntena.  Firstly  the  type  of  mechamsm  is 
chosen  with  a  view  to  get  the  simplest  mecharusm  that  satisfactorily  fulfUl  the  re’^'.mng  three  cntena 
Two  of  these  cntena  are  formulated  as  constraints  on  the  kinematic  behavior  and  the  total  area  occupied 
by  the  mechanism,  respectively  The  fourth  cnieru  ts  singly  the  desired  minimization  of  the  reactive 
forces/moments  that  appear  in  the  mechanism  The  desired  kinematic  behavior  is  based  on  a  finite  number, 
typically  1..6,  of  points  in  time  (positions  of  the  mechanism)  where  the  position  and  onentatioo  of  up  to 
two  output  bodies  may  be  prescnbed.  The  constraints  on  occupied  areas  are  labelled  temtory  constraint' 
and  formulated  as  a  number  of  restncted  areas  (boxes).  A  synthesis  is  automaticaUy  performed  at  5ve 
levels  At  the  first  level  the  structure  of  the  mechanism  is  decided  At  the  second  level  initial  dimensions 
for  the  given  type  of  mechanism  are  found  by  random  checking  At  the  third  level  the  constraints  on  the 
kmemalic  behavior  is  fulfilled.  At  the  fourth  level  the  temtory  constraints  are  taken  into  account  and, 
finally,  at  the  fifth  level  the  minimization  of  reactions  is  earned  out  The  entire  approach  has  been 
impl-mented  in  a  software  package  SYNMEC  that  runs  on  PC’s  and  constitutes  a  way  ot  pertorming  the 
synthesis  of  a  mechanism,  that  is  general  and  flexible  with  respect  to  both  the  type  of  mechamsm  that  may 
be  syrthesized  as  well  as  the  desired  behavior  upon  which  the  synthesis  is  based. 


I .  Introduction 

Whenever  motion  or  power  is  to  be  transmitted  from  one  point  to  another  the  designer  taces  a 
•luri  ber  of  decisions  that  must  be  taken  iii  order  to  get  on  with  the  design  process: 

•  mechanical/not  mechanical  transmission 

-  geax-Zcam-ZlinkagC’/combmcd  mechanism 
'  number  and  type  of  drivers 

•  structure 

The  evaluation  of  these  decisions  can  only  be  done  by  applying  some  kind  ol  dimensional 
synthesis  taking  into  account  the  different  demands  and  wishes  ot  the  specififc  problem  Synthesis 
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of  mechanisms  typically  involves  a  number  ot  criteria  of  varying  nature  and  complexity  There 
are  however,  three  types  ot  criteria  that  almost  always  can  be  identified  in  practical  examples 

•  kinematic  behavior 

•  surroundings 

-  dynamic  behavior 

Since  the  original  work  by  Fox  and  Willmert  (2|  on  mechanism  synthesis  using  minimization 
techniques  much  anention  has  been  paid  to  problems  whith  both  kinematic  ana  ,:ynamic  behavior 
as  criteria,  e  g.  (1]  and  (5).  In  the  current  work  a  procedure  for  synthesis  ot  mechanisms  is 
presented  that  take  into  account  all  three  types  of  criteria  Also  some  of  the  decision  making  is 
covered.  The  ^proach  is  inspired  by  the  work  by  Garrett  and  Hall  (3]  that  used  random  search 
as  pan  of  the  synthesis  proc^ure  and  the  work  by  Soni  et.  al  [6)  where  the  mechanism  type  is 
decided  on  the  basis  of  the  desired  behavior  of  the  output  body 

The  presented  ^proach  should  be  thought  of  as  a  tool  Aat.  on  the  basis  of  prescribed  constraints 
on  the  kinematic  behavior  and  the  surroundings,  r^ms  a  number  of  simple  planar  mechanisms 
with  optimized  dynamic  behavior  that  act  as  suppon  to  the  designer  in  deciding  whether  to  use 
mechanisms  and  if  so  which  one  to  pick.  The  types  of  mechanisms  that  are  taken  into  account 
have  one  independent  input  and  only  contain  lower  pair  joints.  Hence,  prior  to  using  the 
procedure,  the  designer  must  choose  to  spend  time  investigating  whether  mechanical  transmission 
m  the  shape  of  planar  linkage  mechanisms  with  these  characteristics  is  a  usehil  solution  to  the 
problem  at  hand. 

The  basic  idea  of  the  presented  procedure  is  the  multi  level  approach.  The  input  is  the 
constraints  on  the  kinematic  behavior  (prescribed  motion  for  one  or  two  output  bodies)  and  the 
territory  constramts  (restricted  areas)  A  total  of  five  levels  are  recognized.  At  the  first  level  the 
structure  of  the  mechanism  is  decided  based  on  the  number  of  output  bodies  and  the  type  of 
motion  prescribed.  At  the  second  level  Initial  dimensions  for  the  given  type  of  mechanism  are 
found  by  random  checking.  This  level  is  also  only  based  on  the  prescribe  kinematic  behavior 
At  the  thiid  level  the  constraints  on  the  kinematic  behavior  is  fulfilled  exactly  by  minimization 
At  the  fourth  level  the  territory  constraints  are  fulfilled  and,  finally,  at  the  fifih  level  the 
minimuation  of  reactions  (optimization  of  dynamic  behavior)  is  carried  out. 

The  entire  method  has  been  implemented  in  a  computer  program  SYNMEC  and  frequently  in 
the  remaining  paper  references  will  be  made  to  the  default  settings  m  SYNMEC  that  influence 
the  automated  perfomance  of  the  synthesis 


2.  Synthesis  input 

In  order  to  perform  any  synthesis  it  is  necessary  with  some  input  representing  the  task  to  be 
carried  out.  In  the  current  work  the  desired  kinematic  behavior  as  well  as  the  territory  constraints 
(restricted  areas)  are  required. 

The  kinematic  behavior  is  the  basis  of  any  mechanism  synthesis.  It  corresponds  to  the  motion 
of  the  output  body(ies)  of  the  mechanism  and  it  is  always  prescribed  in  some  way,  often  as  a 
function  of  the  motion  of  the  input  body(ies)  Classically  tins  prescribed/desired  kinematic 
behavior  is  discretized  into  a  relatively  limited  number  (here  1  6)  of  points  in  time  where 
positions  and/or  rotations  of  output  and/or  input  bodies  are  of  significance  to  the  functionality 
ot  the  mechanism  These  points  in  time  will  be  referred  to  as  positions  of  s>nthesis.  The  mam 


advantage  ot  looking  at  the  mechanism  in  a  limited  number  points  is  the  reduced  time  ot 
^computation.  The  main  disadvantage  is  that  the  mechamsm  might  act  in  an  unexpected  way 
between  the  positions  ot  synthesis 

In  the  current  implementation  up  to  two  output  bodies  may  be  defined  as  either  rotating, 
translating,  or  general  motion,  see  Figure  2  I 


Output  body 


(a>  (b)  (c) 


Ftgure  2. 1  fa)  rotating  output  body,  (b)  translating  output  body,  (c)  general  motion  output  bodv 
Each  bodv  is  shown  in  the  j'th  position  of  synthesis  (continuous  line)  and  the  I  si  position  of 
synthesis  (dotted  Une).  The  different  quantmes  that  are  prescribed  are  shown 

For  a  rotating  output  body  the  rotation  relative  to  the  tirst  position  of  synthesis  is  prescribed 
•  y  •  2  K.,, 

where  is  the  number  of  positions  of  synthesis.  For  a  translating  output  body  the  translation 
relative  to  the  first  position  of  synthesis  is  prescribed 

■  y  •  2  v> 

For  a  general  motion  output  body  there  exist  a  point  of  interest.  The  rotation  of  the  body  and  the 
motion  ot  the  point  ot  interest  relative  to  the  first  position  of  synthesis  are  prescribed  In  order 
to  relate  the  point  of  interest  relative  to  the  surroundings  ns  position  m  the  first  position  ot 
synthesis  is  also  prescribed: 

-  y  ■  2  ^pot 

'  y  ■  2  n^Qj 

h  - 

Each  variable  may  be  prescribed  in  three  different  ways 

1  X  IS  free 

2  X  *  C 

3  Cl  <  X  <  C, 

where  X  denotes  any  variable  and  the  C’s  are  the  prescribed  constants 
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Restricted  areas  are  simply  defined  as  a  number  of  boxes,  see  Figure  2  2.  The  mechanism  must 
stay  outside  these  boxes  in  any  position  (not  only  the  positions  of  synthesis)  The  advantage  of 
using  boxes  of  restriction  is  that  it  is  possible  to  generate  both  convex,  and  concave  outer  limits 
as  well  as  isolated  areas,  e  g  ,  a  beam  passing  ihorugh  the  plane  m  which  the  mechanism  is  to 
be  synthesized 


Figure  2  2.  Box  of  restncnon  area.  Vie  box  i$  gi\en  by  five  parameters,  x^,  y^,  4.  and 


3.  Mechanism  structure 

There  is  no  such  thing  as  an  optimal  mechanism  structure  for  a  given  task  There  are.  however, 
some  simple  rules  such  as  the  fewer  movable  bodies  the  better  and  rather  revolute  joints  than 
translational  joints  According  to  this  it  1$  always  a  good  idea  to  try  and  solve  the  problem  using 
a  four  bar  mechanism  as  the  one  shown  in  Figure  3.1. 


Figure  S  I  Four  bar  mechanism 

For  one  reason  or  another  the  four-bar  mechanism  might  not  be  a  good  choice  Naturally,  if  the 
desired  kinematic  behavior  is  prescribed  as  two  general  motion  output  bodies  it  is  necessary  to 
look  at  a  mechanism  with  more  movable  bodies  that  are  not  directly  connected  to  the  frame 
Normally,  however,  the  choice  of  structure  can  only  be  evaluated  after  a  number  of  dimensional 
syntheses  has  been  performed  The  results  could  indicate  that  it  is  impossible  to  fulfill  all 
constraints  or  that  the  dynamic  behavior  lies  at  an  unaccqitable  level  subject  to  these  constraints 
Then  it  is  necessary  to  investigate  another  and  more  complex  structure  or  simply  to  realize  that 
It  IS  not  a  good  idea  to  use  one  degree  of  freedom  mechanisms  to  the  current  task 
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The  philosophy  used  in  this  work  is  based  on  the  above  observations  and  it  says  depending  on 
the  number  ot  output  bodies  and  the  prescribed  motion  tor  these  bodies  a  list  ot  mechanism  types 
IS  generated  The  first  type  is  the  simplest  and.  thus,  the  one  that  is  checked  first  and  so  on  Each 
check  involves  the  remaining  four  levels  described  in  the  previous  section  carried  out  a  specific 
number  ot  times  The  designer  may  st(^  as  soon  as  an  acceptable  design  is  reached  or  as  soon 
as  It  becomes  clear  that  this  mechanism  type  cannot  solve  the  problem  satisfactorily 
In  Figure  3  2  the  generated  lists  tor  some  ot  the  different  possible  output  combinations  are 
shown 


Figure  S.  2.  Mechanism  rypes  listed  in  tnat  sequence  they  are  checked  for  different  combinations 
of  output  bodies  (a)  one  rotating  output  body,  (b)  one  translating  output  body,  fc)  one  general 
motion  output  body,  and  (d)  two  general  motion  output  bodies 

In  Figure  3  2  The  letters  i  and  o  (with  indices  added  in  case  of  two  output  bodies)  stands  tor 
input-  and  output  body,  respectively  Alternative  output  bodies  tor  the  same  structure  are  shown 
as  (2nd  alternative)  and  {3rd  alternative).  The  only  exception  to  the  restricted  use  ot  lower  pair 
joints  IS  the  double  crank  (no.  7  m  3rd  list)  where  it  is  understood  that  some  kind  ot  gear 
prescribes  the  rotation  of  the  two  bodies  connected  to  the  frame  relative  to  each  other 
Naturally  the  designer  may  rearrange  the  sequence  of  each  list  or  totally  omit  one  or  more  types 
In  the  current  implementation  a  fixed  total  of  18  mechanism  ij^es  with  up  to  five  movable  bodies 
are  previously  defined,  (f  the  designer  wants  to  check  more  complicated  types  he  must  also  define 
the  structure  m  the  structure  editing  facilities  of  SYNMEC  Each  mechanism  is  stored  as  Assur 
Groups  and  cranks  (see  also  (4|)  which  makes  it  possible  to  have  a  both  general  and  effective  set 
of  analysis  routines  for  the  calculation  of  positions,  velocities,  accelerations,  and  reactive  torces 
and  moments  Also  the  subdivision  m  Assur  Groups  is  of  great  advantage  in  the  general 
identification  of  design  variables  (see  Section  4).  calculation  of  analytical  sennitiviiies  (see  Section 
S).  and  lire  segments  (see  Section  6) 


4.  Initial  search 


After  the  selection  ot  a  mechanism  type  the  next  step  is  to  add  some  dimensions  The  simplest, 
and  in  the  authors  view,  most  effective  way  of  doing  this  is  by  generating  a  large  number  ot 
mechanisms  and  picking  out  a  specific  number  that  best  ftilfili  the  desired  kinematic  behavior 
It  could  be  argued  that  also  the  territory  constraints  should  be  included  in  this  random  search. 
This  IS  omitted,  however,  because  it  is  much  more  time  consuming  to  check  if  a  mechanism  has 
moved  into  restricted  areas  m  any  position  rather  than  checking  its  kinematic  behavior  in  a  few 
positions  of  synthesis  Thus,  the  initial  search  returns  a  number  of  mechanisms  with  a  kinematic 
behavior  relatively  close  to  the  desired  but  with  no  regard  to  the  surroundings. 

In  order  to  randomly  generate  dimensions  for  a  mechanism  type,  two  things  a  necessary* 
identiticatton  of  design  variables  and  upper  and  lower  limits  for  each  of  these  The  design 
variables  may  be  divided  into  two  categories  geometrical  and  kinematical  variables  The 
geometrical  variables  make  up  the  actual  dimensions  of  the  mechanism  Consider  the  four-bar 
mechanism  in  Figure  4.1 


Figure  4. 1  Four-bar  mechanism  skov.n  in  the  j  ‘th  position  of  synthesis  The  coupler  link  is  used 
as  a  general  motion  output  body 

For  this  mechanism  the  nine  geometrical  variables  are* 

j:,.  y,.  L,.  U.  Ly  Xp.  yp 

The  kinematical  variables  are  the  relative  rotations  of  the  input  body  in  each  position  ot  synthesis 
as  well  as  the  rotation  in  the  first  position  of  synthesis* 

^1/  *  -/  ■  2-  flpoj 

Hence,  (he  design  variables  X  are  made  up  by  a  fixed  number  of  geometrical  variables  and  a 
number  of  kinematical  variables  depending  on  the  number  of  positions  of  synthesis 

X  •  (Xj,  >1.  X^.  y-i-  i-l.  ^3’  ^12’ 

In  genera  there  are  also  one  or  more  configurational  parameters  that  describe  how  the 
mechanism  is  assembled.  For  the  tour-bar  mechanism  there  is  one  such  parameter  These 
configurational  parameters  are  part  of  the  variables  that  decide  the  behavior  of  the  mechanism, 
but  they  should  not  be  mixed  with  the  design  variables  because  they  always  are  fixed  during  a 
dimensional  synthesis  and  therefore  belong  to  the  structural  data  In  SYNMEC  the  different 
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contlgurauons  are  taken  into  account  during  the  initial  search  by  simply  checking  each 
configuration  for  each  randomly  selected  set  ot  design  variables 

The  automated  identification  ot  the  design  variables  and  their  their  upper  and  lower  limits  is 
done  simultaneously  Firstly,  some  characteristic  length  must  be  determined  tor  the  problem  at 
hand,  In  the  current  work  the  desired  kinematic  bdiavior  is  used  to  generate  this  number  by 
taking  the  average  of  the  sizes  ot  the  prescribed  translations/motions  If  only  relative  rotations 
are  prescribed  the  characteristic  length  is  simply  set  to  1  The  limits  are  automatically  prescribed 
as  follows 

-i  <  length  <  M. 

10  ^ 

-3Z.^  <  coordinate  < 

0  <  rotation  <  2v 

where  denotes  the  characteristic  length  The  designvariables  tor  the  tour  bar  mechanism  m 
Fig  4  1  may  be  grouped  in  the  toilowing  way 

lengths  ■  Lx.  U.  Lj 
coordinates  Xi,  y,.  u.  y^,  Zp,  yp 
rotations  jS,.  0x2,  .. 

Two  types  of  design  variables,  namely  the  posmori  of  revolute  joints  fixed  to  the  frame  as  well 
as  the  relative  rotations  of  the  input  body  (timed  problems),  may  be  prescribed  in  the  same 
manner  as  the  desired  kinematic  behavior  ($<*e  Section  2). 

Two  numbers  are  of  practical  interest  m  the  initial  search:  the  number  of  designs  that  are  tested 
and  the  number  of  designs  that  are  stored  for  further  use.  In  the  current  version  of  SYNMEC  the 
automatically  selected  values  for  these  numbers  arc  20000*nconf,j  and  20.  respectively  The 
number  represents  the  number  of  configurational  paiameiers  for  the  mechanism  type  in 
question  It  should  be  recognized  that  the  purpose  of  the  loitu'l  search  not  is  to  cover  the  entire 
design  space  (this  is,  even  for  simple  mechanisms  m  a  relativ^My  1  v  positions  ot  synthesis,  a 
computationally  discouraging  task)  but  to  get  a  number  of  reasonably  good  mmal  designs 


5.  Kinematic  behavior 

The  initial  search  returns  a  number  of  designs  that  have  a  imematic  behavior  close  to  the  desired 
one  Next  step  is  to  change  these  mechanisms  with  a  view  to  fulfill  the  desired  kinematic 
behavior  exactly.  Both  during  the  initial  search  and  the  subsequent  synthesis  a  iG.-^uiaiion  ot  the 
deviation  trom  the  desired  kinematic  behavior  is  required.  For  *hat  purpose  the  tunction  I  is 
introduced 

(.V  -  C,)=  ,  X  <  c, 

/  (X)  .  0  .  C,  S  X  S  c. 

(X  -  c.)-  ,  X  >  c; 
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Here  Ci  and  represents  lower  and  upper  Umits,  respectively,  that  are  prescribed  for  the 
variable  X  If  X  is  exactly  prescnbed  to  some  value  C  this  corresponds  to 

c,  -  c  «  c 

If  X  is  a  free  variable  we  have 

C,  ■  -00  ,  a  •  CO 

In  the  case  of  a  rotating  output  body  the  deviation  is  formulated  as; 

^  (^it) 

The  index  K  refers  to  kinematic  deviation.  In  the  case  ot  a  translating  output  body  the  deviation 
IS  formulated  as; 


0|t  ■  E  '  <«!;) 

Finally,  for  a  general  motion  body  the  deviation  is  formulated  as; 

Dk  ■  I  (/’lx)  • '  (V  •  E  '  ('’i/.)  * '  ‘  Wi/) 

A  weijhtfactor  w  is  introduced  to  eUmmae  the  difference  in  magninide  between  (lengtlf )  and 
(angle^l.  In  SYNMEC  the  automatically  chosen  value  for  w  is: 

rad‘ 

which  approximately  corresponds  to  saying  that  an  angular  deviation  of  30^  should  equal  a  length 
deviation  of 

The  minimization  of  is  performed  using  a  Fletcher'DavidomPoweli  routine  The  sensitivities 
are  calculated  analytically  which  increases  the  speed  of  calculation  significantly. 

As  an  example  consider  the  four-bar  mechanism  in  Figure  5. 1  which  is  one  of  the  results  of 
an  initial  search 


Figure  5  I  Initial  mechanism  shown  in  four  posuions  of  synthesis  The  desired  position  of  the 
point  of  interest  P  in  each  positions  of  synthesis  is  indicated  by  a  reaangle 
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The  desired  behavior  is  as  tollows 

Pi  =  (0.  0)  P,;  =  (75. 0)  P,3  =  (75,  50)  P,^  =  (0,  50) 

Furthermore,  the  relative  input  rotations  are  prescribed  to 

80*  <  ^,2  <  lOO”  170*  <  i3,3  <  190*  260*  <  0^  <  280* 

The  minimi2ation  returns  the  mechanism  shown  in  Figure  5  2. 


Figurt  5  2.  Synthesized  mechanism.  Kinematic  constraints  has  been  token  into  account  and  the 
point  of  Interest  passes  exaaly  through  the  four  prescribed  rectangles. 

It  should  be  noted  that  the  mobility  of  the  mechanism  not  is  checked  in  the  positions  between  the 
positions  of  synthesis. 


6.  Surroundings 

Whether  a  mechanism  is  to  be  fitted  into  an  existing  environment  or  designed  together  with  its 
environment  there  will  always  be  some  kind  of  r^uiremems  upon  the  amount  of  space  that  may 
be  occupied.  These  territory  restrictions  can  be  of  a  very  varying  nature,  e.g  ,  some  constraints 
are  only  active  in  certain  periods  (other  moving  machinery)  and  some  orJy  reters  to  some  of  the 
bodies  of  the  mechanism 

In  order  to  examine  the  area  swept  by  a  mechamsm  it  is  necessary  to  analyze  it  in  a  number  of 
positions  that  satisfactorily  describes  its  continuous  bdiavior.  In  SYNMEC  a  mechanism  is  by 
default  analyzed  in  35  positions  between  the  first  position  of  synthesis  and  the  last. 


Figure  6  I  To  mechanisms  subdivided  into  five  and  eleven  line  segments,  respectively. 
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As  mentioned  in  Section  2  the  territory  constraints  are  defined  as  a  number  of  fixed  boxes  In 
SYNMEC  It  IS  automatically  assumed  that  all  bodies  should  stay  outside  any  box  at  any  time 
The  area  o'.cuppied  by  a  mechanism  is  best  obtained  if  the  mechanism  is  divided  into  tine 
segments  In  Figure  6  I  the  subdivision  of  two  mechanisms  into  five  and  eleven  line  segments, 
respectively,  is  shown. 

Each  line  segment  must  stay  outside  each  box  of  restriction  in  each  analyzed  position.  How 
much  a  Ime  is  inside  (violates)  a  box  is  illustrated  in  Figure  6  2  where  three  out  of  tour  possible 
incidents  that  may  occur  between  a  line  segment  and  a  box  are  shown.  The  fourth  incident 
corresponds  to  the  segment  lying  outside  the  box  m  which  case  A  s  0 


Figure  6  2.  A  box  of  resmaion  and  a  line  segment  that  represents  part  of  a  mechanism  arc 
shorn  in  three  different  incidents'  (a}  the  line  segment  lies  inside  the  box.  (b)  the  line  segment 
crosses  the  edges  of  the  box  once,  and  (c)  the  line  segment  crosses  the  edges  of  the  box  mce 
For  each  case  the  corresponding  violation  of  the  box  4  Is  shown. 


In  the  case  where  the  line  segment  crosses  the  edges  twice  it  is  necessary  to  include  4*  to  avoid 
(hat  the  minimization  routine  just  positions  the  Ime  segment  peipendicular  to  the  crossed  edges 
Denoting  the  violation  of  the  I'th  box  of  restriction  by  the  j'th  line  segment  4,^  it  is  possible  to 
set  up  an  expression  for  the  total  deviation  from  the  territory  constraints  in  s  single  analyzed 
position: 

E  a; 

/•* 

where  the  number  of  boxes  of  restriction  and  line  segments  are  denoted  and  n^^.  respectively. 
The  index  T  refers  to  lemtoty.  The  division  by  the  total  numbers  of  violations  is  done  in  order 
to  get  an  average  value  that  directly  can  be  added  to  the  kmcmatic  deviation  without  the  risk 
of  being  dommating.  In  SYNMEC  only  the  maximum  value  of  Dy^.  as  opposed  to  summing  £>}■ 
from  each  analyzed  position,  is  included  in  the  mimmization.  This  is,  naturally,  done  because 
of  the  immense  gam  in  computational  efficiency  The  drawback  is  that  a  minimization  step  where 
only  one  analyzed  position  is  considered  might  cause  even  higher  values  of  Dj  in  other  aiialyzed 
positions  In  SYNMEC  this  problem  has  been  by  mcludmg  m  the  minimization  the  three 
analyzed  positions  that  most  recently  have  comatned  maximum  Dy  value. 

A  deviation  that  take  into  account  both  kinematic  and  temtory  c(>nsiraints  can  now  be  stated  as 


where  Dj  ^  is  the  sum  of  Dy  values  of  the  three  previously  mentioned  positions.  The 
minimization  of  can  be  performed  directly  on  a  mechanism  delivered  by  the  initial  search 


Dr*  —T 
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or  to  a  mechanism  where  already  has  been  minimized  The  laner  is  the  default  approach  in 
SYNMEC, 

As  an  example  the  mechanism  in  Figure  5  2  is  considered,  see  also  Figure  6  3 


V" 


°  J 


w 


0^^  Cl, 


Figure  6  3  The  mechanism  in  Figure  5  2  with  territory  constraints  added.  Four  beams  lying 
perpendicular  to  the  plane  has  to  be  avoided  by  the  mechanism  The  beams  are  indicated  as 
hatched  rectangles. 

Four  beams  lying  perpendicular  to  the  plane  are  introduced  as  four  boxes  of  restriction  and  a 
minimization  of  returns  the  mechanism  shown  in  Figure  6  4 


Figure  6  4  Synthesized  mechanism  Kinematic  and  territory  constraints  have  been  taken  into 
account 

It  should  be  noted  that  SYNMEC  by  default  only  examines  the  period  between  the  Erst  and  the 
•ast  position  of  synthesis.  It  must  be  stated  specifically  if  the  territory  txinstraints  should  be  active 
for  a  full  360°  rotation  of  the  input  body. 

Because  the  mechanisms  are  thought  of  as  lines  the  designer  must  take  into  account  that  the 
dimensions  of  the  real  mechanism  t^es  up  more  space  (width  of  links,  bearings  etc.)  by  defining 
tougher  ferntory  constraints. 


7.  Dynamic  behavior 

Any  mechanism  will  be  subject  to  some  kind  of  <ippi!cd  loads  as  well  as  inertia  forces.  These 
loads  cause  reaaive  forces/moments  to  appear  in  the  kmemaiic  joints  as  well  as  the  input 
force$/momen:s  required  to  generate  thv  desired  motion  In  this  (X)ntext  the  dynamic  behavior  is 
recognized  as  those  reactions  Consequently  the  purpose  of  optimizing  the  dynamic  behavior 
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corresponds  to  ntisinuzing  the  sum  ot  the  sr^ed  resaht  tbrces.  If  the  enire  diisensioaal 
ss-nthesis  ts  regarded  as  an  opumizatioa  problem  a  sboiJd  be  torrsuJxed  as: 

Niinimize  reaaive  torces 

subject  to  kinematic  and  termors*  ec  traicts. 

It  is  the  experiertce  of  the  author  that  the  main  problem  m  duxxasiorul  sstuhesis  is  to  simply  find 
a  mediamsm  that  meets  both  the  coastraims  on  the  kinematic  bdiavior  as  udi  as  the 
surroundings.  Hence,  the  difficult  part  is  to  get  into  the  feasible  design  area  uhereas  the 
subsequent  improsement  in  dynamic  benavior  is  less  of  a  problem. 

It  is  npical  t^  a  rdatisely  modest  change  (at  least  to  the  human  e>‘e)  of  the  design  vanabies 
of  a  su^ani^m  may  give  at  sigmficam  improvement  in  the  dynamic  behavior. 

No  applied  loads  need  to  be  defined.  The  ouqmt  bod>(ies)  are  simply  subjeaed  to  unit  loads  as 
shoun  in  Figure  7.1. 


(a)  (t,) 


to 


Figurt  7 1  The  axaomancalbi  applied  loads  ustd  on  (a)  a  rotowj$  oiapui  body ,  (b)  a  translanng 
ouipui  body,  and  (c)  a  general  motion  ouipui  body. 

The  approach  taken  m  SYNMEC  is  very  stable  but  also  rather  slow  In  order  to  avoid  the 
problems  of  weighting  fundamentally  di^erem  quamities  such  as  reactive  forces  ai.. 
lengths/angles  the  calculation  of  the  f.^camic  hdiavior  is  isolated  ftom  the  calculation  of  the 
deviation  ^m  the  constraints.  This  is  ’  •vt  m  the  following  way  a  mechanism  is  generated  that 
fulfils  the  constramts.  The  first  des  gr  xi^-ble  tb«  i'  iMt  prescnbed  to  be  exaaly  equal  to  some 
constant  is  perturbed  a  certain  amount.  This  means  that  the  mechanism  do  longer  fulfils  the 
kinematic  and  territory  constramts  and  a  mininuzationof  is  performed  but  with  the  perturbed 
variable  fixed  to  its  new  value  If  is  reduced  to  an  acceptable  value,  i  e..  the  value  it  had 
before  the  perturbation,  then  a  new  feasible  mecbamsm  has  been  generated  and  its  dynamic 
behavior  may  be  compared  with  that  of  the  oiigmal  one.  This  is  repeated  for  each  design  variable 
and  the  pertubation  that  caused  the  greatest  improvement  in  the  dynamic  behavior  is  selected  as 
the  new  design.  Now  the  entire  proces  of  perturbing  each  design  variable  may  be  repeated  and 
so  on.  The  minimization  ot  the  reactive  forces  is  repeated  until  none  of  the  fixed  pertubauons 
caused  any  improvement  or  (v^hich  is  what  normally  happens)  I>u.  cannot  be  minimized  to  an 
acceptable  level  for  any  of  the  dynamically  improved  designs  The  size  of  the  pertubauons  are 

coordinates  and  lengths'  LJ20 

rotations'  1* 
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It  should  be  ooced  dm  a  cew  duraetenstic  lecstb  is  calculaud  as  the  averse  ot  ail  Itnk 
lengths. 

The  embed  b  basically  quite  slow  because  of  the  many  minimizations  of  but  a  feanire  that 
strongly  increases  the  emcieocy  has  been  tsrroducsd;  the  first  s'ariable  tnat  b  penurbed  in  anv 
except  the  first  step  t$  the  one  that  gave  tse  greabst  improvement  in  the  previous  step  If  this 
perturbation  followed  by  the  mininuzation  still  causes  the  dynamic  behavior  to  be  improved 
it  b  used  again  without  checking  the  other  pertuibaooas  Namt^Iy.  one  might  nsk  to  overlook 
a  penurbatiOQ  that  gbns  a  beaer  improvemem  but  in  practise  it  works  very  well 
The  dynamic  behavior  in  a  specific  analyzed  poutioa  b  calculated  as: 

=  E  «r 

I-! 

where  b  the  number  of  reactions  and  R  are  the  reactbns  It  should  be  noted  that  if  R,  is  a 
moment  h  b  divided  by  the  updated  charactenstic  length  L^.  The  dynamic  behavior  used  as  the 
object  of  minimization  is  the  maximum  value  of  to  order  to  find  that  one.  the  continuous 
behavior  of  the  mechanism  is  required  just  as  in  the' case  of  the  territory  constraints  and.  hence, 
the  same  number  of  analy'zed  positions  are  used 

As  an  example  the  mechanbm  in  Figure  64b  subjected  to  a  minimization  of  the  reaaions  and 
the  result  is  shown  in  Figure  7  2. 


3  3  a  3  '  □ 


Figure  7  2  Syruhesized  mec/uinism  Kine/mmc  and  temiory  constrairus  as  \irll  as  dynamic 
behavior  has  been  taken  into  account 

Although  not  much  has  happened  the  obtained  improvement  in  is  22% 


8.  Example 

In  this  s^ion  an  example  that  demomtrates  the  mam  idea  of  the  approach  discussed  in  this  paper 
IS  given  The  variety  of  solutions  that  may  be  obtained  ^ould  give  the  designer  a  fair  chance  of 
either  picking  a  reasonable  design  or  choosing  not  to  use  the  types  of  mechanisms  handled  in 
SYNMEC  to  solve  the  problem  at  hand 

A  body  IS  to  be  approximately  vertically  translated  inside  a  square  room,  see  Figure  8  1 
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Figure  B  1.  The  kinemanc  and  territory  constraints  Vie  mechanism  should  stay  Mthin  the  square 
and  the  point  of  interest  of  the  output  body  should  move  inside  the  vertical  band  to  the  right 
During  the  vertical  motion  the  output  body  should  not  rotate  more  than  10"  to  either  side 

Hie  kinematic  behavior  is  accordingly  prescribed  as  follows 

P,  =  (90,10)  -2  <  Piit  P,4j  <  2  P,2y  =  10  P,3y  =  20  P,4y  =  30 

-10*  <  ^,2  ^14  <  10* 

Furthermore,  the  following  constraints  are  laid  upon  the  relative  input  rotations 
30“  <  ^12  <  60*  70*  <  ^13  <  100*  no*  <  /J,4  <  140* 

The  territory  constraints  are  defined  by  four  large  boxes  of  constraint  that  make  sure  the 
mechanisms  do  not  move  outside  the  room,  see  Figure  S  2 

am  im) 


<•1044  •toot) 


Figure  8  2  The  four  boxes  of  restnctton  that  define  the  territory  constraints 
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A  small  portion  of  the  us^le  mechanisms  are  shown  in  Figure  S  3a  e  N'o  dynamic  behavior  has 
been  optimized  for  any  ot  these  mechanisms 


Figure8  3a.  Synthesized  mechanisms,  (a)  four  bar  mechanism  (b)  six  bar  mechanism,  (c)sixbar 
mechanism  (same  sirucmre  but  as  (b)  but  alternative  output  body),  continued  on  the  next  page, 
(d)  another  six  bar  mechanism,  and  (e)  five  bar  mechanism  (double  crank) 


'  9.  Conclusion 

In  the  current  paper  an  approach  to  the  combined  structural  and  dimensional  synthesis  of  planar 
rigid  body  mechanisms  is  introduced.  The  automated  version  of  the  approach  is  emphasized  with 
a  view  to  present  a  method  that  only  requires  input  the  designer  concerning  the  actual 
problem  (and  nothing  concermng  the  mechanisms)  in  order  to  return  a  number  of  synthesized 
mechanisms  Both  kinematic  and  territory  constraints  may  be  prescribed  in  a  new  and  general 
way  An  optimization  of  the  dynamical  behavior  subjea  to  these  constraints  may  optionally  be 
carried  out. 

The  approach  is  .  ided  into  five  levels  that  include  picking  a  mechanism  type,  doing  a  random 
initial  search,  and  performing  dimensional  synthesis  with  respect  to  kmematic  behavior  first,  then 
territory  constraints,  and,  finally,  dynamic  behavior 

Future  work  will  a  o.  concentrate  on  more  complex  ways  of  defining  the  territory  constraints, 
e  g  .  taking  into  account  that  some  obstacles  only  are  present  at  certain  times  and  only  have 
’  intluence  at  certain  bodies  of  the  mechanism  Also  the  possibility  of  defining  any  shape  of 

particular  bodies  will  be  included 

I 
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ABSTRACT  The  aim  of  this  work  has  been  to  develop  a  method  tim  can  be  used  within  synthesis  of  spacal 
mechanisms,  specifically  on  the  problem  of  designing  a  mechanism  for  which  a  coupler  point  can  de^be 
a  given  path,  given  by  a  number  of  discrete  points 

In  order  to  maintain  the  method  general,  i  e  be  able  to  work  for  arbitrary  mechanisms,  a  general  analysis 
method  is  used  a$  the  basic  tool,  and  to  maintain  a  mmimal  number  of  degrees  of  freedom  the  joint  or 
relauve.  formulauon  <  employed  No  attemps  are  being  made  to  match  the  points  exactly  Instead  an 
opamizauon  procedure  is  employed  (o  mimmize  the  distance  from  the  path  of  the  coupler  point  and  the 
desired  path 

In  order  to  stabiUre  the  procedure,  a  conunuation  method  is  applied  in  conjunction  with  the  optiinizaoon 
method  so  that  the  desired  path  are  gradually  changed  from  points  bemg  close  to  points  on  the  iniual  coupler 
curve  to  the  ones  actually  desired  With  this  combination  a  method  for  synthesizing  a  spaual  mechanism 
towards  a  mechanism  that  can  descibe  a  given  coupler  curve  has  been  developed  that  is  both  general  and 
stable 


1  1.  Introduction 

IV 

I  In  this  paper  the  problem  of  paihgenerauon  for  spatial  mechajusms  is  treated  I  e .  a 
;  procedure  is  developed  with  which  dimensions  for  a  given  type  of  mechamsm  may  be 
determined  m  order  for  a  point  on  the  mechamsm  to  traverse  a  given  path. 

C  For  planar  meebamsms  this  has  been  dealt  with  for  many  years  and  both  textbooks  and 

\  papers  treaung  the  subject  are  available,  c.g.  fl»91  The  general  approach  m  most 

^  presentations  have  been  to  focus  on  one  specific  type  of  mechanism  and  develop  a  method 
(  for  synthesizing  that  particular  mechamsm  Only  few  papers  treat  more  general 

y  formulations  that  are  capable  of  dealing  with  arbitrary  mechamsms  Examples  of  this  arc 

HAUG  &  SOHONl  (3)  and  HANSEN  (10) 

Synthesis  of  spatial  mechamsms  has  not  been  explored  to  the  same  extent  yet  Among 
the  work  published  ANGELES  fH]  and  CHIEN  et  al  [12J  give  interesting  examples 
These  papers,  however,  deal  with  specific  mechamsms.  and  the  methods  are  not  applicable 
for  arbitrary  mechamsms 

In  this  paper  a  synthetis  method  is  iniroduccd  based  on  an  analysis  program  that  can 
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deal  with  arbitrary  spatial  mechaiusms  h  is  thus  capable  of  synthesizing  general  spatial 
mechanism  to  generate  a  given  path. 

The  analysis  method  is  based  on  the  joint  vanable  formulation,  described  for  closed  loop 
dynamics  of  rigid  bodies  in  NIKRAVESH  &.  GIM  (131,  so  that  a  minimal  set  of  degrees 
of  freedom  is  used  dunng  the  analysts,  making  the  analysis  phase  very  efficient 

In  the  synthesis  phase,  the  distance  between  the  desired  spatial  curve  and  the  one 
actually  generated  by  the  current  design  of  the  mechanism  is  nummized.  This  is  earned 
out  by  making  a  splme  interpolation  of  both  curves,  and  then  measure  the  distance  as  the 
sum  of  squares  of  two  sets  of  points  equally  spaced  along  each  curve.  The  synthesis  phase 
consists  of  a  imnimization  of  this  distance  by  a  standard  optimizauon  procedure,  letting 
a  number  of  the  dimensions  of  the  mechamsm  be  the  design  variables 

As  already  obser\'cd  by  others,  e.g.  [8},  (11],  the  minimization  procedure  applied  to 
mechamsms  may  not  be  able  converge  if  the  imtial  guess  is  not  very  close  to  the  desired 
configuration  This  problem  may  be  overcome  by  usmg  a  continuation  method.  (8),  [10], 
[II]  The  basic  prmciple  behind  this  is  to  define  a  senes  of  intermediate  paths,  that  arc 
defined  by  interpoiauon  between  the  path  generated  by  the  imual  design  and  the  desired 
one.  The  rmmmization  procedure  is  then  earned  out  sequentially  for  each  of  the 
intermediate  paths  This  stabilizes  the  procedure  considerably. 


2.  Analysis  method 

The  analysis  method  is  based  on  the  joint  coordinate  formulauon  as  described  m  ( 1 3)  Th’y 
method  consunitcs  an  efficient  analysis  tool  wiUj  which  arbitrary  mechanisms  can  be 
analysed.  The  concepts  of  the  method  is  summarized  here.  For  a  more  detailed  cxplariation 
the  reader  is  referred  to  (13]  or  NIKRAVESH  (14] 

Assume  that  the  j’lh  joint  in  a  mechanism  is  a  revolutc  joint,  that  connects  body  j  -  1 
and  body  j ,  as  shown  in  Fig.  1. 


Fig  1  A  rcNoluceioint  connecting  iwo  bodies  Hic  joint  vanable  IS  0. 
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If  the  position,  fj., ,  and  rotation.  A^, ,  as  well  as  the  revolute  joint  axis,  Uj .  and  the 
joint  variable  6j  are  known,  the  position  and  rot^on  Aj  of  body  j  can  be 
determined  (Boldface  symbols  denote  vectors  and  matrices). 

Similar  relations  are  valid  for  other  types  of  jomts,  and  for  a  cham  of  bodies,  the 
position  and  rotation  of  each  body  may  be  found  if  the  onentation  of  the  base  body  and 
the  vector  0  of  jomt  coordmaies  along  the  chain  arc  known  This  is  readily  extended 
to  more  complex  tree-structures,  so  that,  knowing  the  posmon  and  rotation  of  the  root 
body  and  the  joint  coordinates  of  all  the  jomts  in  the  tree,  the  onentation  of  all  bodies  in 
the  tree  may  be  deteirmned. 

Meebamsms,  however,  usually  includes  one  or  more  closed  loops.  To  deal  with  this,  the 
loops  are  cut  at  one  of  the  joints  m  each  of  the  loops,  and  mathematical  expressions  are 
derived  that  expres  the  loop  closure  conditions  For  the  revolme  joint,  e.g.,  there  are  three 
Cartesian  coordinate  conditions  that  ensure  that  the  two  bodies  connected  by  the  joint 
actually  meet  at  the  jomt,  and  two  alignment  conditions  that  ensure  that  the  o^y  relative 
rotation  between  the  two  bodies  is  rotation  about  the  revolute  jomt  axis 

The  conditions  are  assembled  in  the  constramt  vector  'F  and  the  loop  closure 
condiuons  are  wntten  as 

7(6)  ■  0  (» 

To  this  vector  the  driver  constramts  are  added  m  a  maimer  similar  to  one  found  m  e.g 
NIKRAVESH  (15],  but  expressed  in  joint  coordmates.  The  set  of  nonlinear  equations  are 
solved  in  a  senes  of  discrete  posiuons  of  the  dnvers  using  the  Newion-Raphson  procedure 
as 


C^'Ae,.,  -  -7(6,)  (2) 

9..1  •  0,  ^  ^0k.i 

Here,  C  is  34^/96  and  the  expressions  that  appears  m  C  are  given  m  (14)  for  all 
standard  combinations  of  joints.  Eq  (2)  may  then  be  solved  with  respect  to  the  joint 
vanablcs  in  a  number  of  discrete  time  steps,  corresponding  to  the  desurd  positions  of  the 
dnvers. 

In  Eqs  (1)  and  (2)  only  the  actual  degrees  of  freedom  in  each  joint  enter  as  vanablcs 
resulting  in  a  very  effective  analysis  tool 

Once  the  jomt  vanablcs  arc  detemuned  in  each  tunc  step,  the  posiuon  ard  rolaUon  of 
each  body  may  be  calculated  as  explained  above  The  point  of  interest  used  to  generate  the 
desired  path  is  on,  say,  body  j  Knowmg  the  position  and  orientation  of  this  body,  the 
global  posiuon  of  the  point  of  mterest  is  calculated  as 

s**  »  r  A^'*" 

i  i 

in  which  s^^and  s**  are  the  coordmates  of  the  pomt  of  interest  in  the  local  coordinate 
system  of  body  j ,  and  in  the  global  coordinate  system,  respectively 
With  this  procedure  any  mcchmism  based  on  die  jomts  foi  which  expressions  for  the 
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updating  process  (from  body  j-i  body  j  )  and  the  entries  m  C  have  been  derived, 
may  be  analyzed  In  the  present  work  this  includes  the  revolute,  the  translational  and  the 
spherical  joint. 


3.  Path  generation 

The  objective  of  this  work  is  to  be  able  to  design  a  mechanism  for  which  a  coupler  point 
traverses  a  given  path.  This  is  accomplished  by  mininuzing  the  distance  between  the  given 
path  and  the  one  actually  generated  by  the  mechanism.  Hence,  a  measure  of  the  distance 
is  needed  In  this  work  a  3D*spline  representation  is  employed,  as  will  be  shown  below. 
During  the  minimization  a  "black'box''  subroutme  that  solves  the  problem  as  a  sequenual 
quadratic  programmmg  problem  is  used. 

3  1  THE  3D-SPLINE  REPRESENTATION 

Consider  the  two  spaual  curves  shown  m  Fig  2  It  is  required  to  detcnme  the  distance 
between  the  desired  curve,  .  shown  as  a  number  of  discrete  points  m  Fig  2.  and  part 
of  the  curve,  that  the  current  mcchamsm  generates,  C«  For  now,  assume  that  it  is  known 
which  point  on  the  curve  is  the  first  and  which  ts  the  last  that  is  taken  into  considerauon 
The  curve  has  been  detennined  numencally  by  the  analysis  procedure  desenbed  earlier, 
and  1$  thus  given  as  a  number  of  discrete  points 


highlighted 


The  points  that  make  up  the  two  curves  that  arc  to  be  compared  arc  not  necessarily 
equal  in  number,  and  even  if  they  arc,  there  may  not  be  a  one-lo-one  corrcspondance 
between  the  two  set  points  Hence,  m  order  to  compare  them  it  is  necessary  to  perform  a 
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spline  approximauon  for  each  of  the  curves,  and  from  that  generate  a  new  set  of  points  on 
each  curve  that  can  be  compared. 

The  spline  representation  for  each  of  the  curves  is  found  as  follows  As  the  curve  is 
traversed  from  point  to  point,  the  (linear)  distance  between  two  adjacent  points  is 
calculated,  see  Fig.  3  The  distances  are  summed  and  saved,  so  that  an  approximate 
curvelength  for  each  curve  is  obtained  Each  partial  lengh*  is  then  divided  by  the  total 
curvelcngth,  so  that  a  senes  of  discrete  curveparameters  u,  are  found  I  e ,  the  points  are 
expressed  as  functions  of  u,  as 

*.1 

■y,?  =  y(»,)f  .  n  •  0,  and  u,  =  0 . 1  W 

z,J  z(u.)J 

assuming  there  are  N+1  points  and  N  lines  conncctmg  them  The  curve  parameter  u 
IS  in  the  interval  (0.1)  Each  of  the  set  of  coordinates,  x,  y,  and  z  arc  then  spline 
interpolated  using  a  cubic  spline  rouunc,  with  u  as  spline  parameter 


3  2  THE  OBJECTIVE  FUNCnON 

From  the  spline  rtpresentaiion  of  the  two  curves  it  is  now  possible  to  generate  a  new 
senes  of  points  along  each  curve,  using  equidistant  values  of  u  from  0  to  1  .  Thus  two 
sets  of  points  are  generated  that  will  converge  towards  the  same  pomts  as  the  two  curves 
approach  each  other. 

Assuming  M  +  1  points  arc  generated  along  each  curve,  a  measure  of  the  distance 
between  the  two  curves  may  now  be  calculated  as 


in  which  X  ‘s  the  difference  between  the  curves,  is  the  m’th  (spline  mierpolaied) 


point  on  the  desired  curve,  and  is  the  corresponding  point  on  the  current  curve  Using  | 


(5)  It  IS  thus  possible  to  obtain  a  measure  of  the  diffcncc  between  the  two  curves  that  is 
independent  of  the  wa\  the  points  on  the  desired  curve  are  generated,  and  on  the 
distribution  of  the  points  on  the  coupler  curve.  The  nwasare  x  chosen  as  the  objective 
to  minimize  in  order  to  redesign  the  mechanism  so  that  it  generates  the  desired  curve 

3  3  sENsmvrry  analysis 

In  the  opurmzation  procedure  the  denvauves  of  the  objective  function  with  respect  to 
design  vanabies  are  needed.  The  design  variables  may  be  any  dimension  of  the  mechanism 
that  has  an  influence  on  the  generated  curve,  such  as  link  lengths,  positions  of  joints, 
onentauon  of  jomt  axes,  etc.  In  this  work  the  derivatives  are  approximated  by  numerical 
diffences,  so  that 

3,^  _  Z<b»Abj)  -  x(b) 

ab^  ”  Abj 

in  which  b  is  the  vector  of  design  vanabies.  b^  is  the  k’th  element  of  this  vector  and 
Abk  IS  a  vector  in  which  all  entnes  except  the  k’th  are  zero  The  k’th  entry  is  equal  to 
Abk ,  which  is  "a  small  quanuty".  In  the  exan^les  for  which  the  procedure  have  been 
employed,  a  value  of  .001  has  appeared  resonable. 

By  implementiog  the  denvauves  this  way  the  calculauon  of  thv  gradients  is  easily 
tmpiemeated,  since  only  a  pertubauon  of  one  of  the  dimensions  and  one  analysts  of  the 
mechamsm  is  needed  for  each  gradient.  It  is  thus  agam  the  genera)  analysis  program  that 
IS  needed  to  do  the  calculauons.  The  draw-back  is  that  the  computer  tune  spent  m  the 
synthesis  phase  grows  linearly  with  the  number  of  design  vanabies. 

3  4  THE  INTERESTING  PERIOD 

In  section  3  2  it  was  assumed  that  the  first  and  last  point  on  the  current  curve  were  known 
This  IS  seldom  the  case  and  it  is  desirable  to  avoid  having  to  specify  that 
In  this  work  this  is  avoided  by  specifying  extra  design  vanabies  m  addiuon  to  the  ones 
defined  in  secuon  3.3.  The  fust  is  m  rclauon  to  the  imual  posiuon  of  the  dnvers  Take  e  g. 
a  revolute  joint  with  a  dnver  that  presenbes  a  constant  angular  velocity.  It  is  given  by 


0^  »  ©t  ♦ 


(7) 


Here,  deternunes  the  position  of  the  dnven  body  at  tunc  equal  zero,  and  hence  the 
posiuon  of  the  coupler  point  at  the  imual  tune.  Thus,  mtroducmg  ^  ^  design  vanable 
any  rcsincuons  on  the  iniual  point  on  the  curve  are  removed  Sumiar  vanabies  may  be 
introduced  for  other  dnvers.  Following  the  same  Imc,  the  penod  in  which  coupler  points 
that  should  be  included  in  the  companson  with  tlic  desired  curve  may  be  introduced  as  a 
design  vanable,  defimng  what  is  here  refer^d  to  as  "the  inicresting  penod” 


I 


4.  CondnuadoD  method 


The  above  mentioned  procedure  works  well  if  the  initial  guess  creates  a  curve  that  is  close 
to  the  desired  one  With  p«)or  imual  guesses,  though,  the  method  may  not  converge  One 
way  to  remedy  this  is  to  use  a  continuation  method,  as  used  m  e.g.  [8]  or  [11]  It  is 
employed  as  follows:  Between  the  curve  generated  by  the  initial  mechanism  and  the 
desired  one,  a  number  of  curves  are  determined  by  inteq>olatioo  between  the  two  given 
ones.  The  one  closest  to  the  initial  curve  is  selected  to  be  the  current  desired  curve,  and 
the  optimization  procedure  is  applied  m  order  to  design  a  mechamsm  that  generates  this 
curve.  Then  the  next  curve  is  selected  as  the  desired  curve  etc  uoul  the  ongmal  desired 
curve  IS  selected,  and  a  mechamsm  detenmned  that  is  capable  of  generatmg  the  curve 
Again,  the  two  curves  need  not  be  described  by  the  same  number  of  points,  and  hence 
spline  mterpolauons  are  bemg  performed  on  both  curves,  and  the  mterpolations  between 
the  two  cur\'es  are  performed  on  the  same  number  of  points  on  each  of  the  curves.  It  is 
thus  possible  to  generate  straight  lines  between  corresponding  points  on  the  curves  and 
perform  a  simple  linear  interpolauon  between  these  points 

5.  Examples 

Below,  two  examples  are  given  in  which  the  procedure  has  been  employed  In  the  first 
example,  a  spaual  s!ider>crank  is  synthesized  to  generate  a  straight  line  as  part  of  its 


Fig  4  The  design  vanities  of  the  spanal  slider  crank  h  ts  shown  with  the  values  of  the  initial 
design 
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coupler  cune.  and  tbs  second  is  d:s  spatial  Gsneta  uhssl.  also  found  in  (11).  in  which  a 
<patial  four  bOT  mecbacisxD  is  souiht  designed  so  that  it  can  arise  a  spatial  Osces*a  wheel. 

5.1  THE  SPATIAL  SUDER-CRANK 

Consider  the  spadai  slider  crank  shown  in  Hg.  4.  Tbe  goal  is  to  baxc  pan  of  the  coupler 
curve  geceiaicd  by  a  point  on  tbe  coupler  to  follow  tbe  straight  line  sbown  as  .  Tbe 
design  variables  are  shown  in  Fig.  4.  too.  Tb^*  are  tbe  leoghts  of  the  coupler,  b,  and  tbe 
crank  \ ,  tbe  location  (b3.b4.b])  oftbensnlutejoint  that  tbe  crack  rotates  about,  the 
directioD.  pvca  as  the  tw'o  sperit^  an^es  and  by .  of  this  joist  axis,  u, .  and  tbe 
coordinates  of  tbe  coupler  point  ( b,.  tv  b^ ).  In  addidoo  to  that  the  twn  conditions  for  the 
interesting  period  are  used  as  design  variables,  giving  a  total  of  12  design  \*ariables.  Tbe 
desired  straight  line  is  ^ven  by  10  points  along  tbe  line  from  ( *005. 0.20.  *0.10 )  to 
( -0.15.  0.20.  *0.10  ).  Tbe  miQ^  desira  is  pven  by 

{b}'  =  {  0.30.  0.10,  000.  0.12.  0.10..  (g) 

0.0.  0.0.  0.05.  005.  0.05.  0.05.  0.30) 


Fsg  5  Ihc  tioal  design  of  (he  sp3.ial  sbdo  cnnk 

The  synthesis  was  earned  out  using  4  continuation  steps  In  each  continuation  step  an 
average  of  15  iterations  was  needed  in  the  opumizauon  process,  and  the  final  design 


4^8 


\*2nab!es  »cre 


(br  =  (  0.284.  0.073.  0.0S6.  0.070.  0.209.  1.776.  0.300. 

-0.197.  -0046.  0.056.  0  171.  0.1 15| 

O  Icidal  curve.  *icteresdng*  pan 
'  '  *  Isidalcunv.restofcurv'e 


O  Desued  curve 

A  -  Found  cuo'c,  'iateresting*  pan 


z 


z 

Fig  6  The  ir.«ia].  the  desued  and  the  tesulwig  curve  for  ibe  spaual  sbdcr-cnnk  mechanism.  sho«n  m 
four  view  dirocQOctt 

At  the  end  of  the  iterations  the  objective  function  had  a  value  corresponding  to  an 
average  deviation  of  about  1  mm  between  the  (wo  curv».  The  resulimg  mechanism  i$ 
shown  in  Fig  5  In  Fig.  6.  the  initial  coupler  curve,  the  desired  one.  and  the  one  generated 
by  the  procedure  are  shown. 


f 


<2.  THE  SPATIAL  GENEVA  WHEEL 

This  example  may  also  be  found  in  (11).  vvbexe  the  sx-ntbesis  is  perfonned  using  a 
procedure  specifically  designed  for  the  spatial  four  bar  mechanism  with  four  revolute 
joints. 

The  goal  is  to  generate  a  spatial  four  bar  mechanism  with  four  revolute  jomts.  that  can 
drive  the  spbencal  geneva  wheel  shown  m  Fig.  7. 


? 


I 


Fig  7  Hjc  $phenc4i  geneva  wheel 

From  (11)  it  is  known  that  if  the  four  revolute  jomts  are  placed  on  the  sphere,  then  it 
IS  possible  to  design  a  spatial  four  bar  mechazusm  that  can  drive  the  wheel  The  path  that 
the  coupler  point  must  follow  in  order  to  drive  the  wheel  is  given  m  [1 1)  as 


X 

cosysma 

y  = 

siay 

zj 

cosycosa 

with 
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'  ‘  Rg  8  The  fjna!  design  of  the  Geneva  wheel 

- 1 

[  ^  Since  the  joints  are  restneted  to  lie  on  the  unit  sphere  with  the  joints  axes  bemg  directed 

M  from  the  centre  of  the  sphere  pointing  radially  out  through  the  joint  points,  both  the 
position  of  the  joints  and  the  direction  of  the  jouit  axes  are  defined  through  the  two 
I »  sphcncal  angles  of  the  joint  axes.  Hence,  the  design  parameters  are  the  two  spfaencal 
angles  for  each  joint  and  the  coordinates  of  the  coupler  pomt,  shown  as  P  mPig  7.  and 
the  two  interesting  penod  parameteres,  giving  a  total  of  13  design  vanables  The  inmal 
'*  configuration  is  the  same  as  the  one  given  in  (IIJ,  which  corresponds  to  the  design 
*  vanables  being 


4$| 


i 


(12) 


(b}^  =  (0  8633.0-'326.1.2(».0  9800.0.3661.0.9795.0.7074 

0  4326.0 0000.0  0000.0.0000.0  0000.0  3000} 

□  -  Initial  cur\'e,  ’interesong*  pan 

Initial  cun*e.  rest  of  curve 
O  Desired  curve 


Fig  9  'Hie  iiuaal,  (he  desired  aroS  the  final  curve  for  the  Geneva  wheel,  shown  in  four  view  directions 

The  optmuzation  procedure  was  again  appbed  using  4  conunuauon  steps  Here,  though, 
the  linear  interpolation  between  the  curves  was  not  used.  Since  the  curve  is  known  to  he 
on  the  sphere,  the  interpolations  were  made  on  arcs  between  the  initial  and  desired  curves 
to  ensure  that  the  intermediate  curves  were  on  the  sphere,  too 
In  this  example  tir  ^auuzer  needed  an  average  of  23  iterauons  in  each  step,  and  the 
final  values  of  the  design  variables  were 
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(13) 


(bi‘  =  {0  8633.06516.1.254,1013.03722,0  9902.0  5643. 

0  7269.0.1255.-0  1 164.-0  2166  0  8607.0  297ll 

The  resulting  mechanism  is  shown  m  Fig  8.  and  the  imtial.  the  desired  and  the 
generated  curves  are  shown  m  Fig  9  in  this  example,  too.  the  value  of  the  objective 
hincuon  corresponds  to  a  deviation  of  about  1  mm  from  the  desired  curve. 

6.  Conclusion 

In  this  work  a  general  purpose  tool  has  been  developed  with  which  it  is  possible  to 
synthesize  the  path  generation  for  arbitrary  spatial  mechamsms.  The  method  is  based  on 
a  general  purpose  analysts  method  It  is  therefore  not  restneted  to  particular  mechanisms, 
but  IS  capable  of  synthesizing  any  mechamsm  that  can  be  analyzed  with  the  analysis 
program  Also,  the  desired  path  is  desenbed  by  a  number  of  discrete  pomts.  and  it  is 
therefore  possible  to  define  arbitrary  paths  as  desired  curves 
Introducing  the  "interesung  period”,  i.e.  the  posiuon  of  the  mput  links  at  imtial  time  and 
the  interesting  time,  as  design  variables,  the  need  to  specify  which  part  of  the  coupler 
curve  that  is  the  pathgeneraung  part  has  been  elunmated 
To  improve  ^e  stabihty  properties  m  the  procedure  a  conunuation  method  is 
implemented  I  e .  the  procedure  does  not  attempt  to  generate  the  path  directly  from  the 
imual  guess  on  the  dimensions,  but  instead  the  d^ired  curve  is  gradually  changed  towards 
the  actual  desued  one  m  a  number  of  steps,  and  an  optimization  procedure  is  applied  m 
each  step  to  nunimize  the  difference  between  the  two  curves 
At  present,  the  sensitivity  analysis  is  performed  with  fimte  difference  approximauons 
of  the  sensmviiies.  The  major  draw-back  of  that  is  that  the  method  is  very  slow,  since  a 
sensitivity  caicuiauon  requires  a  complete  analysis  for  each  design  v''nable  A  natural 
conunuauon  of  this  work  is  to  implement  analytical  sensmviues  in  the  procedure 


7.  References. 

(1)  Erdtnan.  A.  G  and  Sandor,  G  N.{  "Mechanism  Design  Analysis  and  Synthesis", 
Prcnucc  Hall,  New  Jersey,  1991. 

(2)  Erdman.  A  G  and  Sandor,  G  N  "Advanced  Mechanism  Design  Analysis  and 
Synthesis",  Prcnucc  Hall,  New  Jersey,  1991. 

(3)  Haug,  E  J.  and  Sohom.  V  N .  "Design  Scnsiuviiy  Analysis  and  Oplimizaiion  of 
Kinematically  Driven  Systems",  m  Computer  Aided  Analysis  and  Optimization  of 
Mechanical  System  Dynanucs,  NATO  ASI  Senes.  Ed  •  E  J  Haug  pp  499-554 

(4)  Kramer,  S  N  and  Sandor,  G  N .  "Selective  Precision  Synthesis  •  A  General  Method 


453 


of  Optimization  for  Planar  Mechamsms”.  Journal  of  Engineering  for  Industry*.  1975 

[5]  Root.  R  R ,  Ragsdell.  K.  M .  "A  Survey  of  Optinuzauon  Methods  Applied  to  the 
Design  of  Mechamsms”.  Journal  of  Engmeenng  for  Industry.  1976 

(6]  Slams,  G.  and  Flugrad,  D.  R.:  "Five-Bar  Path  Generation  Synthesis  by  Continuauon 
Methods".  Advances  in  Design  Automation.  1991. 

[7J  Subbian,  I ,  Flugrad.  D.  R .  "Four-Bar  Path  Generation  Synthesis  by  a  Continuauon 
Method",  Advances  in  Design  Automauon.  1989 

(8]  Tsai,  L.  W  and  Lu.  J.  J.*  "Coupler-Pomt-Curve  Synthesis  Using  Homotopy 
Methods",  Advances  in  Design  Automauon.  1989 

(9)  Tsai,  L  W  and  Morgan.  A  P .  "Solving  the  Kinemaucs  of  the  Most  General  Six- 
and  Five-Degree-of-frcedom  Manipulators  by  Conunuauon  Methods".  Journal  of 
Engineering  for  Industry,  1984 

(lOJ  Hansen.  M.  R.  "An  Automated  Procedure  for  Dimensional  Synthesis  of  Planar 
Mechamsms",  Structural  Opumizauon,  Feb.  1993 

[11]  Angeles.  J  and  Liu.  Z :  "A  Constramed  Least-square  Method  for  the  Opumizauon 
of  Sphencal  Four-bar  Path  Generators",  m  Mechanism  Synthesis  and  Analysis.  1990, 
Ed ’s:  McCarthy.  M.,  Derby,  S.  and  Pisano,  A, 

[12]  Chiang,  C  S.,  Chicng.  W.  H.  and  Hoeltzel,  D.  A  "Synthesis  of  the  RSCR 
Mechamsm  for  Four  Precision  Pomis  with  Relaxed  Specificauons”,  m  Mechamsm 
Synthesis  and  Analysis,  1990.  Ed.'s  McCarthy.  M ,  Derby.  S  and  Pisano.  A 

[13]  Nikravesh.  P  E.  and  Giro.  G..  "Sysicmauc  Construebon  of  the  Equauons  of  Motion 
for  Mulubody  Systems  Contammg  Closed  Kinemauc  Loops",  Paper  no  89-DAC-58, 
Proc.  ASME  Design  Automauon  Conference,  Montreal,  Canada.  Sept.  17-20, 1989 

[14]  Nikravesh,  P  E  "Computauonal  Methods  m  Mulubody  Systems".  Lecture  notes 
from  COMETT  course  on  Computer  Aided  Analysis  of  Mechanical  Systems. 
Lyngby.  May  1991 

[15]  Nikravesh,  P  E  "Computer  Aided  Analysis  of  Mechamcal  Systems".  Prenuce  Hall, 
1988 


L 


454 


DYNAMIC  SIMULATION  IN  WEAPON  SYSTEM  DESIGN 


Robert  M.  Dombroski 
U.S  Army  ARDEC 
SMCAR-FSA-F  Bldg  61N 
Picatiimy  Arsenal.  NJ  07806*5000 


ABSTRACT,  Artillery  Armaments  Division  of  the  Ftm  Suppon  Armament  Center 
(FSAC).  has  been  mvolved  in  the  mechamcal  computer  aided  engineering  (MCAE)  of 
weapons  systems  smee  1987  During  this  time  Artillery  Armaments  Division  has  become 
FSACs  acknowledged  experts  in  computerized  we^n  ^stem  a^id  munmons  design  and 
analysis  Artillery  Armaments  Division's  ci^abtlity  curmntly  encompasses  all  aspects  of 
computer  aided  design,  conceptual  solid  modelmg,  Bmte  element  modelling  and  analysis, 
dynamic  we^cn  system  analysis,  computer  aided  manufaenmng  analysis  and  computer 
aided  drafting,  ArtiUety  Armaments  Division  is  at  the  forefront  of  computer  hardware, 
software  and  networking  technology. 

1his  pi^er  will  discuss  the  development  of  a  liquid  propellant  (LP)  armament  system  for 
a  self  propelled  howitzer.  The  LP  weapon  system  is  bemg  developed  as  one  of  the  future 
weapon  concepts  under  the  Advanced  Fire  Suppon  Armament  System  program.  The  LP 
effon  demonstrates  the  latest  m  all  MCAE  fields,  conceptual  design,  finite  element 
modeUmg  and  analysis,  computer  aided  drafting,  and  computer  aided  dynamic  sunulauon 
and  analysis  This  p^r  will  focus  on  the  dynamic  modelling,  simulation  and  analysis 
used  m  the  design  and  production  of  a  prototype  we^xm  system  as  well  as  the  key  role  that 
analysis  plays  m  the  design  cycle. 


Weapon  System  Design 

In  the  past,  it  took  the  U.S  Army  approximately  15  years  for  request  to  delivery  on  much 
of  us  fielded  equipment  More  recent  figures  mdicate  a  iO  year  lead  time  This  is 
unacceptable  The  Fire  Support  Armament  Center  (FSAC)  of  the  U.S.  Anny  s  Aimameni 
Research.  Development  and  Engineering  Center  (ARDEC).  Picaiinny  Arsenal.  NJ,  has 
mcreased  us  use  of  MCAE  technology  to  dramatically  reduce  design,  development,  and 
tunc  to  production  by  one  third 
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Typically,  the  design  cycle  is  a  chaotic  and  undocumented  process  at  worst,  and  a  slow, 
sequenual  process  at  best,  with  progress  measured  by  the  "ihrown*over-ihe-wall-to- 
milestone.  This  leads  to  a  ’build-test-fit*  development  t^cle  whete  the  final  product  design 
IS  dictated  by  whether  or  not  it  is  tune  for  the  design  phase  to  end  FSAC  took  a  three 
phased  approach  to  the  problem  of  a  sequential,  poorly  defined  design  effort.  First.  FSAC 
implemented  a  distributed  computmg  architecture  which  support  synchronization, 
optimizauon  and  refinement  of  the  information  flow.  Next  FSAC  adopted  a  unified 
representation  of  the  design  itself,  which  could  be  accessed  by  all  the  elements  of  a 
concurrent  engineering  team.  Finally,  FSAC  implemented  an  integrated  set  of  MCAE 
software  which  streamlined  the  design/analysis  process  This  effort  resulted  m  an 
electromc  capability  which  not  only  enables  concurrent  engineering,  but  encourages  design 
by  analysis  of  future  we^n  systems 

Liquid  Propellant  Design  Program 

TTic  Artillery  Armamenis  Division  (AAD)  is  FSACs  primary  artillery  weapon  system 
research  and  development  organization.  AAD  has  taken  the  lead  at  ARDEC  in  both  MCAE 
c^ability  and  concurrent  engmeenng  AAD's  missum  is  to  provide  total  lifecycle  systems 
engmeenng  of  amUery  systems.  AAD  is  responsible  for  planning,  duectmg,  performmg 
and  controlling  the  research,  conceptual  design,  engmeering  development,  product 
engineering,  product  usprovement  and  producibility  engineering  for  material  including 
light  and  medium  towed  and  air  mobile  artillery,  medium  and  heavy  self*propetled  aiollery. 
mortars,  recoiUess  rifles  and  their  mumtions  AAD  is  also  responsib'  i  for  the  conceptual 
design,  analysis  and  preliminaiy  development  of  fumre  weapon  systems  which  will 
unprove  the  firepower  of  the  U  S.  Army 

One  such  project  is  development  of  a  liquid  propellani  ^annon  for  use  m  self  propelled 
artillery  systems  Ihis  cannon  has  many  advantages  over  solid  propellant  weapons  such  as 
reduced  manufacturing  costs,  less  waste  in  fielding  charges,  and  less  labor  to  handle  the 
ammuiunon.  The  aimament  system  is  being  designed  by  General  Hectnc  ui  parallel  with 
the  Artillery  Armaments  Division  and  Benet  Labs  of  ARDEC  who  are  designing  and 
fabncatmg  the  gun  mount  and  the  breech  mechaiusm  respectively  as  well  as  modifying  the 
vehicle  to  accept  the  new  system  Usmg  Pro  Engmccr  software  from  Parametric 
Technologies  Corporation  and  Patran  Plus  from  PDA  Engmeenng  and  IDEAS  from  SDRC 
Inc  designers  from  AAD,  located  at  Picatinny.  and  Bcnct  Labs,  located  at  WaiervUel  NY. 
were  able  to  create  theu  respective  parts  simultaneously.  Dynamic  analysis  usmg  DADS 
from  CADSI  Inc.  was  performed  by  analysts  at  Picatinny  on  the  completed  assembly. 

Its  IS  difficult  to  put  a  value  on  the  tune  that  was  saved  usmg  an  mtegrated  MCAE  dcsipi 
and  analysis  capability.  However,  the  design  was  completed  at  least  30%  faster  than 
previous  projects,  and  that  mcludes  many  more  design  iterations  and  analysis  permutations 
than  would  have  been  possible  m  the  past.  Other  benefits  came  downstream  m  the  process 
from  attainmg  a  more  fine  r.med  design  fit,  that  more  closely  meets  specifications  As  a 
result,  lime  typically  required  for  the  knock*down,  reanalyze,  redesign,  rebuild  and  retest 
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cycle  was  cut  significantly 
WORKING  IN  PARALLEL 

In  FSAC's  concurrent  engineering  e^orts.  the  software  selected  not  only  automates  the 
engineering  tasks,  it  actually  allows  FSAC  to  change  their  workflow  to  better  facilitate 
commumcations,  teamwork  and  early  involvement.  In  FSaC,  the  design/development 
process  has  been  re*engineered  to  take  full  advantage  of  our  MCAE  tools  FSAC's 
mechamcal  design  efforts  center  on  the  solid  model.  The  mam  reasons  for  this  are  the  solid 
model's  ability  to  enable  all  team  members  to  visually  the  product  from  the  earliest  stages 
of  the  design  (^lase  and  the  fact  the  the  solid  model  contains  all  the  physical  characteristics 
of  the  produa,  makmg  it  much  more  accurate  than  wireframe  or  drawings 
Once  detailed  parts  of  the  liquid  propellant  system  were  completed,  subassemblies  and 
the  mam  assembly  were  analyzed.  Here,  many  mmor  revisions  were  made  to  each  part, 
adjustmg  chambers,  bolt  holes,  and  matmg  surfaces  for  fit.  First  cut  drawmgs  were 
generated  as  designers  finished  each  part,  and  electromcaliy  forwarded  to  draftsmen  who 
created  final  drawmgs.  A  solid  model  view  of  the  Ui^d  propellant  Gun  System  is  shown 
in  figure  1 


In  FSAC's  concurrent  engmeenng  environment,  analy,.«s  dnves  the  design  as  opposed  to 
validatmg  it.  As  a  result,  the  design  team  is  provided  with  early  and  contmuous  feedback 
on  many  or  all  aspects  of  the  design,  including  such  thmgs  as  performance,  survivability, 
reliability  and  manufacturability.  Inconsistencies,  design  flaws  and  so  on  are  trapped 
earlier  m  the  design  phase  which  greatly  reduces  expensive  and  tune-consummg  redesign 
later  m  the  development  process. 

Analysis  on  vanous  elements  of  the  gun  mount,  cradle  and  cab  began  as  soon  as  models 
had  been  roughed  out.  Deflection  m  the  cradle  was  exammed  usmg  Swanson  Analysis 
Systems  Inc.'s  ANSYS  fimtC'cIement  analysis  software,  as  was  a  static  analysis  of  the 
loads  on  the  mounung  pomt's  liftmg  cylmders.  Anticipated  loads  on  the  cab  were 
determmed  with  CADSFs  DADS  software.  Results  were  post-processed  m  Patran  where 
several  areas  of  unacceptable  stress  and  deflectxtxi  were  uuheated,  proroptmg  modification 
to  ongmal  designs  early  in  the  design  process.  Typically,  the  need  for  these  changes 
would  not  have  been  discovered  until  a  prototype  was  built  and  tested. 

SIMULATION  IN  'niE  DESIGN  PHASE 

Histoncally,  when  modellmg  and  redcsignmg  mdiiar/  systems  and  subsystems  such  as  an 
automatic  loader  design  engmeers  had  two  alternatives.  The  first  and  most  often  chosen 
was  not  to  design  a  new  item  but  to  adapt  existmg  subsystems  to  meet  new  requuemenis 
The  second  alternative  was  for  an  engmeer  to  wnte  specialized  FORTRAN  codes  to 
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perform  specific  analysis  fimaions 

Advanced  hardware  and  software  technology  is  now  providing  engmeers  with  a  third 
option,  to  design  new  systems  without  writing  custom  equations  of  motion  but  rather  to 
utilize  motion  analysis  software  This  technology  allows  designers  to  enhance  existing 
engineering  designs  through  analysis  results  and  realistic  visuabzauon 

DADS,  the  Dynamic  Analysis  and  Design  System,  was  used  to  model  the  LP3  gun 
mount  and  automatic  loader  mechanism  as  well  as  to  design  and  analyze  the  crucial  breech 
control  cam  system  DADS  allows  designers  to  quickly  and  effe.,ively  address  complex 
questions  and  analyze  design  performance.  Dynamic  and  kmemauc  'ysis  is  used  to 
understand  how  the  mdividual  pans  within  an  assembly  move  and  what  forces  they  endure 
when  the  assembly  mteracts  with  external  forces. 


The  Breech  Mechanism 

The  breech  is  made  up  of  two  pans;  a  breech  camplate  and  a  crank  The  crank  moves 
along  two  campaths  The  ftrst  campath  controls  the  loclung  and  unlocking  of  the  breech 
while  the  second  campath  actually  swings  the  breech  mto  the  open  position.  The  mouon  of 
the  gun  tube  during  recoil  acuvates  rollers  which  mo^v  n  'he  campaths  and  drive  the 
motion  of  the  crank.  As  the  roller  moves  along  the  f'rr  C4mnath  it  unlocks  the  breech 
mechanism  After  a  brief  delay  the  second  roller  is  ed  As  the  roller  moves  along, 
the  breech  door  swings  open  to  allow  loading  of  the  j;rojectile  ard  iiuniuon  This  motion 
is  depicted  in  Figure  2. 

The  objecuve  of  the  motion  analysis  was  to  alter  the  two  campath  so  tha  the  breech 
door  would  open  without  mierference  An  cx:««..g  leader  syr '«as  used  as  a  baseline 
design.  This  loader  was  madequac  because  of  an  mteifcxcnx  betw<*,.,n  the  autoloader, 
breech  and  gun  tube. 

The  modellmg  of  the  breech  mechanism  focused  on  2  dureitsioroi  kineroaic  analysis 
For  analysis,  the  mechanism  was  broken  mto  Indivtdjal  Acdiec  This  breech  model 
consists  of  two  bodies,  the  breech  camplate  and  the  cranx.  ^aa  des:nbmg  these  bodies 
and  their  mterconneaion  was  entered  with  a  menu«<inven  preprocessor  An  on-lme  mput 
data  error  checkmg  facility  inunediaely  detects  meet  common  errors  such  as  unproper 
boundary  conditions  or  connecuvity 

After  creaung  the  bodies,  the  designer  defined  the  jouits  usmg  a  library  of  jomt  elements. 
To  complete  the  cam<foUower  jomt  defimtums,  the  designer  also  ^>ecified  the  imual  contact 
angle.  This  is  an  estunae  of  the  uutial  angle  of  contact  and  the  pomt  on  the  body  which  is 
to  follow  the  track  a  all  tunes.  The  engineer  the*'  defines  a  driver,  which  in  this  case  was  a 
simple  polynomial  The  driver  defties  the  x  moaon  the  crank’s  pivot  pomt 

Once  these  elements  were  creaed,  the  daa  was  submitted  for  analysis.  iTie  ar,' lysis 
program  automatically  assembles  the  model  to  saisfy  consmants  unposed  by  the  defined 
jomis  The  progran  then  constructs  the  equations  of  motion  and  estunae^  of  the  initial 
location  and  onentanon  of  the  bodies.  Hie  solutions  to  the  equatiotis  are  touii4  by  using  a 
vanable  order  nme*step  prediaor-corrcaor  algonthm 
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Ftgtiro  2.  Breech  iiieclianisni  cam  p.ith 


The  designer  then  examined  the  results.  The  interpretation  of  results  is  the  most 
important  phase  uf  the  analysis  process.  It  provides  immediate  venfication  of  whether  the 
imnal  design  meets  the  specificauons  as  entered.  The  analysis  results  mclude  the  positions, 
velocities  and  accelerauons  at  the  centers  of  gravity  of  all  bodies  and  other  chosen  pomts 

VISUAUZATION 

The  hill  visual  impaa  of  the  breech  door  and  the  enure  loader  mechanism  in  motion  was 
made  possible  through  sophisticated  simulation  capabilities  of  the  analysis  program. 
Designers  were  able  to  italisncally  see  the  crank  successfully  move  through  the  campaths 
and  the  mouon  of  the  breech  door  and  autoloader  mechanism  during  the  firing  cycle  After 
the  irutial  modelling  of  the  breech  mechanism  and  the  loader  was  developed  and  analysis 
performed,  a  detailed  arumauon  was  created  by  adding  more  complex  geometry  The  full 
animauon  depicts  the  gun  tube  and  other  components  in  detail,  and  depicts  the  entire 
armament  system  as  it  functions  through  an  entiiC  load,  fire  and  recoil  cycle  Deoendmg 
on  the  designers'  purpose,  the  simulation  and  animauon  of  the  design  can  be  simple  or 
con:plex.  A  simple  model  is  used  for  initial  visual  ^.onfirmauon,  while  a  complex  model 
can  be  develop*^  for  presentauon  purposes  A  sample  of  the  DADS  simulation  model  is 
shown  in  figure  3 

BENEFITS  OF  SIMULATION 

The  simulation  of  the  autoloader  and  breech  cam  was  mvaluable  to  the  design  process  In 
addiuon  to  enabling  the  campath  design  and  analy$'.s.  it  visually  depiaed  all  the  kinematic 
relauonships  between  the  recoding  parts,  the  cradle,  breech,  ballistic  shield,  autoloader  and 
the  vehicle  tunet.  Without  this,  space  claim  and  mterference  checking  during  system 
dynamics  would  cause  design  mUestones  to  be  adversely  impacted.  The  animated  model 
commumcated  the  mechamcal  concepts  involved  in  the  design  to  all  involved  m  the  projea. 
Also,  from  the  analysis  pomt  of  view,  the  dynamic  data  provided  foTce>load  mfomiation 
which  was  cnucal  to  to  the  detenninauon  of  the  strength  of  the  cradle  structure.  The 
mteracnvity  of  DADS  and  the  visualization  capabilities  enabled  the  designer  to  examme 
jomt  and  oody  locauons  and  body  masses.  These  he  could  quick^  modify  to  generate  new 
force  load  curves  for  analysis. 


Concurrent  Engineering 

The  Liquid  Propellant  Gun  system  design  effort  was  a  collaboration  of  designers, 
engmeers  and  analysts  from  both  the  federal  and  private  sector  The  Liquid  propellant 
annament  design  was  done  by  General  Elcctnc  in  Pittsfield.  MA  The  breech  mechanism 
was  designed  at  Watervlict  Arsenal.  NY.  The  gun  mount  was  designed  at  Picatmny 
Arsenal  m  Dover.  NJ  The  overall  system  integrauon  was  performed  at  Picatmny  Arsenal. 
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2nd  analysis  effons  were  pe.i'onssd  siaaixaxxously  ax  all  three  locaxions.  Ail 
desi|n  data  and  paragaerers  u'as  accessiMe  ax  each  location  via  elecxroxuc  dau  transfer  of 
solid  nedei  geemeoy.  diss  allowing  each  sabsystem  designer  to  know  bow  tbeir  pomon 
of  the  effoit  cseracxed  «-ixh  the  others.  Design  changes  which  cspactedodiersobsysteais 
v^ere  quickly  identified  avoiding  costly  and  time  consoxning  problems  later  on  in  the 
de\'eiopment  cycle.  Knowug  die  operational  characteristics,  dimensions  and  ^lace 
requirexnents  of  all  die  subsystems  gready  added  to  the  accuxacy  of  the  analyses  penonced 
on  the  system. 

Inxexnally  at  ARDEC.  the  Liquid  propellant  weapon  system  developuent  effon  ^as 
comprised  of  a  wide  range  of  engineering  disci{^<es.  The  ability  for  designers,  analysts, 
simulation  specialists,  draftsmen  and  program  manageis  to  fiincuon  both  tndepesdemly, 
yet  in  an  mtegratsd  and  concunent  manner  could  only  be  accomi^ished  throu^  electronic 
means.  AAD's  design  and  analysis  data  as  well  as  all  its  MCAE  software  resides  on 
various  mainframe  file  servers.  LTdlizing  the  latest  netwodong  techniques.  AAD  is  able  to 
make  this  data  appear  to  each  user  as  a  single  shared  corporate  data  base,  residmg  on  his 
vkoikstation.  Projea  management  software  embedded  in  Pro  Engmeer  orchestrates  overall 
secuniy  and  access  to  common  data. 


463 


BIOGRAPHY' 


Robcn  M.  Domtvoski  is  a  team  leader  in  Amllery  Armament  Division.  Corxe?:  and 
Axtalv'Sis  Branch  ai  ARDEC.  In  addition  to  providing  technical  super\'iston  for  a  multi- 
disci^inaiy  analysis  team  he  is  K^)onsible  f(»  all  the  physical  operational  aspects  of 
AAD*s  MCAE  capability.  Mr.  Oombroski  has  been  re^xmsible  for  the  total  system 
design,  specmcaoon  and  implementation  of  AAD's  MCAE  s>’stem. 

Previously.  Mr.  Dombrosld  was  die  lead  erginecr  for  robotic  systec^s  integration  on  an 
autonomously  functioning  self  propelled  Ixmitzer. 

Mr.  Dombrosld  is  a  graduate  of  St  Johns  University.  Jamaica.  NY  w.di  a  Bachelors 
degree  m  Madiemadcs  and  nas  a  Masters  degree  in  Systems  Management  from  Rorida 
Institute  of  Technology,  Melbourne.  Ronda.  He  has  recently  received  die  ARDEC 
Commanders  Award  for  Civilian  Service  and  the  St.  Barbara's  Medal  for  conmbutions  to 
advancements  in  the  area  of  field  artillery. 


464 


Modelling  of  Automotive  Vehicles  for  Motion 
Control  Studies 


i  COSTA  H.P.  JOSES 

EESC  ‘  f'SP  i'nnxrsit^  oj  tVcrxrtcK 

.4c.  Ccrios  Botelko  U6S  <!tbbett  HtU  Sd. 

IJ560  Sco  Ccrios  CX'i  741  Cortntry 

SP  Bmsii  EnghfUi 


Abstract 

The  subject  of  this  paper  :s  the  application  of  muitibody  system  techniques  for 
venicle  chassis  modelling  aimed  at  the  development  of  integrated  veh.;le  control 
It  realises  that  resulting  models  can  be  complex  and  that  simplihcattons  in  chassis 
description  Is  recommendable.  For  this  pun>ose.  it  has  deNeloped  a  technique  for 
representing  suspension  geometrt  effects,  uluch  by  taking  the  .MBS  structure  into 
account,  results  in  s.mail  and  fast  runtime '<imulatioo  models  Vet.  the  model  is 
capable  of  describing  the  full  range  of  normal  operation  of  the  automoiite  vehicle 
I'siog  the  pieviously  developed  model,  comprehensive  analysis  of  all  aspects  of 
vehicle  motion  is  earned  out.  The  objectives  of  such  analysis  is  the  determination 
of  a  driving  envelope  in  which  the  use  of  linearised  models  of  the  nonlinear  chassis 
can  be  justified  for  control  analysis  and  design. 

1  Introduction 

The  period  following  the  early  1970's  has  seen  a  rapm  increase  m  tlic  application 
of  automatic  ''oiitrol  techniques  in  automotive  vehicles  These  past  and  current 
developments  in  automotive  vehiclecontrol  have  progressed  mostly  m  a  piecemeal 
fashion,  whereoy  individual  vehicle  subsystems,  such  as  the  engine,  suspension 
and  braking  systems  have  been  studied  in  isolation  Future  applications  of  con¬ 
trol  in  automotive  vehicles  will  follow  a  trend  towards  system  integration,  leading 
ultimately  to  the  development  of  integrated  vehicle  control  svsleins  capable  of  co¬ 
ordinating  the  action  of  the  various  subsystems.  The  coordination  and  mtcgialiou 
of  automotive  vehicle  subsystem  control  requires  the  interaction  amongst  the  var¬ 
ious  subsystems  to  be  taken  into  consideration  at  the  control  design  stages,  i  e  . 
a  total  system  approach  to  automotive  vehicle  control  is  needed. 

Those  aspects  of  vehicle  motion  control  which  are  of  primary  interest  span  a 
dvnamic  range  with  a  frequency  cut-off  below  50  Hz.  Up  to  this  frequenev.  siinu- 
irition  studies  of  automotive  vehicle  dynamics  can  justifiably  be  based  on  lumped 
parameter  models  [9]  Current  approaches  to  vehicle  dynamics  simulation  fall  into 

2  distinct  categories  The  first  approach  .nvolves  the  use  of  simple  mathematical 
models  which  are  derived  from  first  principles  and  which  are  usually  assembled 
nianualiy 


The  5econ<i  apptx»ch  to  ^enicie  mnaiuics  simuUtion  .axohes  matitematicAi 
mo<:els  which  incorporate  representations  of  the  \ehicte  kinematics,  t*.  re  char* 
actenstics  and  suspension  geometry  effects  This  approach  to  tehicle  Mvnamics 
«mmlaiton  can  result  in  mathematical  models  which  are  iiiehi.  coniulex.  (on- 
sequeiuly.  automated  model  generation  facilities  based  on  muhil>od>  systems 
i.MBSl  modelling  technioues  are  wideh  emploted. 

.Approaches  to  MBS  modelling  based  on  a  combination  of  Kane's  Metiio<l  [4] 
and  symbolic  computation  has  been  show  n  (Sj  to  generate  tire  most  efhcient  I  run 
iimeJ  simulation  code. 

While  the  use  of  those  more  powerful  and  complex  models  makes  the  idea 
of  an  integrated  control  system  very  difncult  due  to  the  high  nonhnearities  of 
the  equations  of  motion  as  well  as  tne  great  number  of  degrees  of  freedom:  it 
has  not  been  ausnered  yet  whether  a  simplihed  model,  however  taking  some 
relevant  interactions  from  a  control  point  of  view,  into  consideration,  could  result 
m  improved  vehicle  motion.  A  positive  answer  to  such  a  question  would  possibly 
mean,  for  example,  a  reduced  number  of  transducers  and  their  related  apparatus 
necessary  to  be  implemented  :n  a  future  vehicle  m  which  these  concepts  might 
be  applied 

2  Modelling  of  an  Automotive  Vehicle  for  Mo¬ 
tion  Control  Studies 

Apart  from  aerodyr4amic  resistances  and  gravitational  effects,  all  external 
forces  acting  on  a  vehivie  are  applied  through  the  wheels  Consequently,  total 
vehicle  control  wilt  eutail  the  application  of  control  action  ai  the  u  heels,  and  w  ill 
be  based  on  a  combination  of  propulsion,  stcenng  and  suspension  conliol  There¬ 
fore  It  18  necessary  to  develop  vehicle  models  which  are  capable  of  representing 
all  these  actions  simultaneously. 

The  modelling  of  this  work  is  based  on  an  approach  (2).  in  which  SLS’;ensicn 
geometry  effects  are  incorporated  in  a  way  which  does  not  involve  a  deta.ied  rep¬ 
resentation  of  the  suspension  system.  The  basis  o;  he  approach  is  an  empirical 
black-box  representation  of  the  suspension  kinematus  derived  from  readilv  avail¬ 
able  experimental  data  describing  the  suspension  trajectory  at  each  wheel  hub 
and  wheel  orientation  From  this  data,  an  equivalent  swing  axle  or  trailing  arm 
model  IS  derived  using  techniques  from  differential  geometry 

The  simulation  mode!  is  constructed  using  the  MBS  package  SD/FAST  (10), 
and  the  ACSL  [1]  continuous  simulation  language  SD/FAST  combines  Kane  s 
formulation  for  a  MBS  model  with  an  equation  generator  incorporating  a  trans¬ 
parent  symbolic  computation  facility,  while  ACSL  provides  the  siiuulalion  envi¬ 
ronment  necessary  to  solve  these  equations 

2.1  Schematic  Description  of  Vehicle  Model 

A  schematic  view  of  the  nonlinear  chassis  model  is  presented  in  figure  1 
The  model  represents  the  kinematics  of  the  sprung  mass  and  the  four  wheels  and 
incorporates  the  effects  of  geometrical  constraints  associated  with  the  suspension 
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A:  each  «heei.  the  siispensson  zeomein*  effects  are  reoresenied  m  a  hiack  i>ox 
manner  as  a  suing  axle  i3i  connecting  the  uiieel  hub  H  to  the  sprung  mass  via  a 
?«neie  degree  of  freecom  rotational  joint  i  put  joint  I  at  the  point.  The  pin  i>o«iiion 
ana  tile  arm  length  of  the  suing  axle  a.e  denved  emptricaht  from  data  defining 
tile  uheelbase/bump  and  track/buinp  characteristics  at  each  aiieel  hub  The 
ore^cnbed  motion  is  incorporated  in  the  ^muiaticn  code  and  iinposea  to  the 
appropriate  joints. 


♦  *  »* 


Figure  I  Nonlinear  Chassis  Model 


in  all  cases,  the  polynonnal  of  louest  order  which  adequately  fitted  the  data 
was  chosen.  A  comparison  of  these  polynomial  representations  a-^d  (he  co.^re* 
spondiQg  wheelbase  and  track  characteristics  data  is  presented  in  figures  I  and 

3. 

The  variation  m  fore-aft  and  later^  wheel  displacements  described  m  these 
figures  appears  small.  Houei-er.  the  effect  of  these  variations  on  the  Nehicle  pilch 
and  roll  characteristics  is  highly  significant,  particularly  during  vehicle  manoeu- 
vres  associated  with  large  acceleration  levels. 

The  model  provides  a  ten  degree  of  freedom  representation  of  the  chassis,  with 
SIX  degrees  of  freedom  resulting  from  the  sprung  mass  and  one  degree  of  freedom 
from  each  swing  axle  This  results  in  a  nonlinear  twenty  stale  model,  in  which  tlie 
states  correspond  to  ten  generalised  coordinates  and  ten  generalised  speeds  Tins 
swing  axle  model  provides  the  simplest  possible  representation  of  the  suspension 
system  which  is  consistent  with  a  nonlinear  chassis  model  intended  for  motion 
control  studies.  This  chassis  model  represents  the  first  stage  m  the  development 
of  a  vehicle  dynamics  model  for  use  in  motion  control  studies  The  chassis  model 
developed  in  this  chapter  is  based  on  data  corresponding  to  a  luxury  hiiropean 
saloon  car  This  data  was  selected  for  illustration  purpose  only  In  particular. 
It  should  be  noted  that  the  chassis  modelling  approach  presented  liere  is  not 
restricted  to  luxury  saloon  cars  but  is  geneii-  and  applicable  to  a  wide  vanetv  of 
automotive  vehicle  types 

2.2  Topological  Representation  of  MBS  Model 

The  chass's  model  is  considered  as  a  muitibody  system  male  up  from  five  hinge 
connected  rigid  bodies  organised  in  a  tree  topology  ar  described  in  figuie  4  The 
central,  or  base  body  corresponds  to  the  sprung  mass  and  the  four  branch  Ijodies 
to  each  of  the  four  wheels  and  associated  suspension  links 

Associated  with  tiie  base  body  and  each  branch  bodv  is  a  local  iiglit-liandeci 
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Figure  2:  Front  Wheelbase  and  Track  Characteristics 

coordinate  franre  with  fixed  orientavtoo  and  location  (at  the  centre  of  mass)  m 
the  respective  body. 

The  geometncai  description  of  the  MBS  model  can  be  specified  by  a  set  of 
three  >ectors  for  each  of  the  branch  bodies  The  first  of  the  three  %ectcrs  op 
describes  the  position  of  the  pint  joint  relative  to  the  centre  of  gra\  ity  of  the  base 
body  This  vector  is  fixed  in  the  base  bodj  The  second  vector  hp  describes  the 
position  of  the  pin  joint  relative  to  the  centre  of  gravity  of  the  branch  bodj  and 
!s  fixed  in  the  branch  body  The  third  vector  b  describes  the  orientation  of  me 
pm  joint  axis 


Ufi 

Ri^hi  1 

op 

(1.441,0.303,  -0.242) 

(1.441. -0.303. -0  242)  1 

F 

hp 

(0.121,-0  441.0058) 

(0.121.0.447.  0.058) 

b 

(0  966, 0.257,  -0029) 

(0.966.  -0.257.  -0.029)  | 

op 

(-1.516.0  105.  -0  157) 

(-1.516.-0.105  -0.157)  1 

R 

hp 

(  0  016.  -0  645.0.143) 

(-0  016.-0  645.0  143)  | 

nr' 

(0.994.0  0.0  113) 

(0.994.0  0.0  113)  ! 

Table  1  Geometrical  description  of  MBS  chassis  model 

For  each  branch  bodv.  specifications  for  the  \ector3  op,  hp  and  eb  v^ere  ob¬ 
tained  relative  to  this  reference  coordinate  frame  The  vectors  hp  end  b 
derived  using  differential  geometry  and  the  vector  op  was  derived  from  the  veln- 
cle  dime  sional  data  presented  m  table  2.  The  resultant  values  of  the  vectors  op 
hp  and  b  are  preseiiied  in  table  I  To  complete  llie  physical  description  of  tin*: 
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Figure  )  Rear  Wheelbase  and  Track  Charactensucs 


MBS  niodeh  the  mass  and  inertia  matrix  for  each  body  is  required.  Tins  data  is 
also  presented  in  table  2 


a 


Table  2.  Vehicle  inertia  and  geometric  data 


2.3  External  Forces  Acting  on  the  MBS  Model 

Apart  from  gravitational  influences,  the  forces  acting  on  the  sprung  mass  are 
aerodynamic  and  suspension  forces,  which  also  includes  the  effect  of  an  aiitiioll 
torsion  bar  at  the  front  axle.  Suspension  characteristics  are  gi%en  ni  table  3 
Aerodynamic  forces  and  torques  have  also  been  modelled,  but  aie  not  desciibed 
in  this  paper 


I . 


Figure  4:  Topological  Representation  of  Chassis 


The  forces  acting  on  each  unsprung  mass  are  the  longitudinal.  lateral  and 
vertical  tyre  forces,  the  suspension  forces  and  gravitational  forces  Tv  re  charac¬ 
teristics  are  also  described  in  table  3  The  suspension  and  tyre  forces  are  described 
by  tlie  parameters  given  in  table  3 

Each  suspension  force  is  modelled  as  a  spring  in  parallel  with  a  damper  The 
spring  and  damper  forces  are  taken  as  linear  functions  of  tiie  spring  displacement, 
and  displacement  rate,  respectively,  relative  to  the  base  bod).  An  a<iditional  roll 
torque  repreaents  the  effect  of  an  antiroll  torsion  bar  acting  at  the  front  axle  This 
torque  is  modelled,  relative  to  the  base  body,  as  a  linear  function  of  the  left /right 
difference  in  spring  displacements  at  the  front  axle.  Static  values  for  the  vertical 
suspension  and  lyre  deflections  are  computed  to  balance  the  weight  of  the  sprung 
mass  in  the  steady-state 

For  the  linear  tyre  model,  the  longitudinal  tjTC  forces  represent  propulsion 
and  braking  action  These  forces  are  modelled  as  an  externally  defined  forcing 
teim,  where  it  is  assumed  that  wheel  spin  and  wheel  lock  do  not  occur  The 
vertical  and  lateral  tyre  forces  are  represented  as  linear  functions  of  the  vertical 
wheel  displacement  and  wheel's  sideslip  angle,  respective!) 
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2.4  Simulation  Model  of  Chassis 


The  computer  simulation  model  vias  built  using  the  MBS  modeiiing  package 
SD/FAST  and  the  ACSL  continuous  simulation  language  The  SD/FAST  pro¬ 
gram  nrocesses  an  ASCII  source  code  file  coniammg  a  uscr-supphed  desciiotioii 
of  a  MBS  model.  Au  example  of  part  of  th**  program  is  given  below. 

The  resulting  source  code,  which  is  generated  autonomously  by  SD/F.AST. 
consists  of  two  main  FORTRAN  subroutines  and  several  seconda;>  siibroiUines 
.Appro.xiniately  10  s  of  CPU  time  on  aSUN  4/330  computer  was  used  to  generate 
the  resulting  output  hie.  This  output  file  consists  of  around  1500  lines  of  FOR¬ 
TRAN  code,  about  70%  of  which  ts  contained  m  the  main  subroutine  defining 
the  state  denvatives  for  the  equations  of  motion  of  the  MBS  model 

The  approach  to  simulation  model  dexelopment  for  an  automotive  \ehicle 
chassis  system,  desenbed  in  this  section,  has  the  adv’antage  that  tlie  model  can 
be  easily  extended  to  include  nonlinear  tv  re  and  suspension  force  characteris¬ 
tics  vMthout  the  need  to  modify  the  kinematic  description  of  the  sprung  and 
unsprung  masses.  .More  importantly,  the  approach  facilitates  the  development  of 
vehicle  models  which  combine  a  MBS  description  of  the  chassis  with  other  vehicle 
subsystems  which  are  not  amenable  to  MBS  modelling  techniques,  such  as  the 
powertrain  or  a  digital  control  svstem.  but  which  can  be  easily  represented  in  a 
simulation  language  such  as  ACSL 

2.5  Model  Validation 

T  he  amount  of  experimental  data  available  was  very  limited,  and  therefore  ex¬ 
tensive  validation  was  not  possible  to  be  performed,  as  it  would  be  desirable 
The  only  experimental  results  available  consisted  of  the  static  deflections  of  the 
suspension,  as  it  was  used  to  denve  the  swing  axle  model  Other  results  available 
were  an  eegeumodv  analysis  resulting  uviii  timpier  models  m  use  oy  the  veincie  s 
manufacturer  and  which  had  been  previously  validated  by  them. 

The  linear  eigenmode  analysis  was  performed  with  the  computer  simulation 
model  as  a  prelude  to  nonlinear  simulation  experiments  The  natural  modes  of 
tlie  MBS  model  and  their  corresponding  frequencies  and  damping  ratios  were 
computed  using  the  linear  analysis  facilities  of  ACSL.  The  linear  analysis  was 
earned  out  with  the  MBS  model  in  a  steady  state  condition  corresponding  to  a 
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0 

inbtojoint 
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* 
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0  44707413530908 
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0.96S864d3194S9S 

-0.25733705686472 

-0.02927S06393730 

constant  forward  speed  of  20  mfs  Tbe  eigenmode  analysis  resulted  in  four  modes 
corresponding  to  the  sprung  mass  and  four  further  modes,  two  for  each  of  tlie 
front  and  rear  w  heel  pairs.  The  results  were  in  close  agreement  with  experimental 
observation  and  are  presented  in  table  4 


.Modes 

FfeC|Uency  |  Damping 
H  z  1  rd/s  1  Factor 

Front-end  bounce 

1 1 

6.88 

0  206 

Rear-end  bounce 

135 

8  40 

0  266 

Roll  on  springs 

181 

11.38 

0.267 

Vaw  rate/laterai  velocity 

1.29 

8.13 

0  834 

In-phase  front  wheel  hop 

12  02 

75.46 

0.200 

Out-of-phase  front  wheel  hop 

12.50 

78.52 

0  195 

In-pbase  rear  wheel  bop 

13.00 

81.69 

0  304 

Out-of-phase  rear  wheel  hop 

13.05 

81  95 

0  303 

Table  4:  Eigenmode  analysis 

In  the  next  section  extensive  simulations  aie  earned  out  in  older  to  deteinmie 
an  operating  range  and  conditions  for  the  use  of  a  linearised  model  m  control 
system  analysis  and  design  These  simulations  cover  all  aspects  of  vehicle  motion 
under  realistic  operating  conditions  considering  driver’s  inputs  as  well  as  external 
disturbances  For  that  purpose  transient  and  steady-state  analysis  is  perfoimed 
However  only  a  few  results  are  present  for  the  reason  of  space  Full  details  aie 
given  in  [2] 

3  Simulation  and  Analysis  of  Vehicle  Motion 

In  order  to  confirm  the  utility  of  the  previously  developed  model,  as  well  as  chai- 
acterismg  its  behaviour  within  an  operating  range  which  allows  the  definition 
of  appropriate  control  strategies,  for  example,  sets  of  of  operating  conditions  in 
which  linear  approximations  would  still  be  valid,  a  large  number  of  tests  which 
exercise  the  model  wilhm  the  boundaries  ol  its  simplifying  assumptions  was  cai- 
ried  out  These  tests  or  experiments,  arc  defined  to  be  either  driver  inputs  oi 
external  disturbances  and  they  will  be  looking  at  both  transient  or  steadv-stale 
behaviour  of  the  simulation  model  The  analyses  to  be  performed  will  consist 
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of  a  detailed  siuay  of  these  snniiiations  an<l  wiU  include  eigen\atue  aiial>sis  ni' 
leaded  at  ver:{>ing  tlie  validity  of  transient  behaviour  anu  gain  anaivsis.  aimed 
at  determining  the  characteristics  of  the  model's  steadv -stale  characteristics 

Ihe  intention  of  these  experiments  is  to  allow  the  dehniiioii  of  a  diiving  enve¬ 
lope  m  ^vhlch  the  interactions  present,  then  nature  and  magniiude  are  discussed 
and  a  valid  range  of  operating  conditions  for  control  studies  can  be  defined 

3.1  Vehicie  Simulation 

The  simulation  runs  to  be  executed  compiise  two  types  of  manoeuvre:  one  in¬ 
tended  to  analyse  the  vehicle's  transient  behaviour  and  the  another  aimed  at 
obtaining  the  vehicle  steady-state  response  characteristics  However  oiiK  a  few 
results  are  shown  m  this  paper  for  reasons  of  space  The  inieiested  reader  mav 
refer  to  (2j  for  full  details 

3.1.1  Transient  Manoeuvres 

The  simulation  vvliich  is  used  to  analyse  the  the  transient  behaviour  of  the  model 
can  be  divided  in  two  types*  driver  related  inputs  and  external  disluibances 
inputs.  Driver's  inputs  will  be  in  the  propulsion  svsiem.  either  in  acceleration 
or  deceleration  manoeuvres,  and  m  the  steenog  system,  m  cornering  manoeuvre 
External  disturbances  w’iil  consist  of  road  vertical  input. 

The  steering  input  simulations  which  exercise  the  vehicle's  handling  or  sta¬ 
bility  and  steering  control  properties  consist  of  manoeuvres  of  the  so  called  'free- 
control’  type,  in  which  steering  wheel  angle  is  considered  as  the  input 

Quantities  depicted  and  analysed  include  yaw  rate,  lateral  velocity  and  accel¬ 
eration.  loli  angle,  wheel  slip  angle,  lateral  and  vertical  tv  re  forces  As  it  would 
be  expected,  the  variation  of  other  quantities  of  motion  associaietl  w’uh  vehicle  s 
forward  and  vertical  motion  aic  negligible 

For  the  acceleration  and  deceleration  simulations,  the  powertrain  and/or  brak¬ 
ing  system  dynamics  are  considered  in  a  very  approximate  manner.  Deterministic 
functions  of  time  are  adopletl  winch  account  for  typical  time  delays  involved  m 
these  system's  responses  and  the  available  level  of  performance  for  the  ivpe  of 
vehicle  being  modelled.  The  input  quantities  will  be  either  driving  or  biaking 
forces  for  the  linear  ty^e  winch  assume  no  slip  ni  the  longitudinal  motion  of  the 
wheels 

The  road  vertical  inputs  consist  of  crossing  obstacles  of  different  types  such 
that  all  relevant  aspects  of  vehicle  motion  arc  e.xerci8ed  Foi  this  purpose,  out- 
of-phase  triangular  bumps  are  transversed,  together  vvith  terminated  lamp  and 
sinusoidal  road  profile  inputs 

The  quantities  of  motion  which  undergo  significant  variation  and  aie  illus¬ 
trated  in  the  results  include  sprung  mass  vertical  displacement  and  acceleration 
and  pilch  and  loll  angles  For  the  unsprung  masses  vertical  displacement  of  the 
wheel's  center  of  gravity,  tyre  force  and  suspension  travel  aie  mcluded  As  an  aid 
to  the  analysis,  the  road  profile  is  superposed  in  some  of  the  simulation  lesults 
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3.1.2  Steady-State  Manoeuvres 

The  primary  task  of  the  siead> -state  mauoeu\re  smiiiiations  is  to  oi)tain  static 
and/or  steadv-state  response  information  in  otdei  to  assess  the  !inearit%  of  the 
mode!  fui  the  \aiious  quantities  of  motion  mvohed  m  response  to  the  alieadj 
mentioned  inputs  and  disturbances  Another  important  purpose  was  to  determine 
directional  stabilitj  parameters,  related  to  the  specific  vehicle  being  modelled, 
such  as  static  marKiu  undersieer  or  oversteer  behaviour,  etc  Simulation  inns 
which  are  executed  include  cornering  vvith  constant  speed  and  different  steering 
angles,  cornering  with  constant  steering  angle  and  various  forwaid  velocities  and 
transversing  sinusoidal  road  profiles  of  different  lieighis  and  lengths 

In  the  cornering  at  different  speed  simulation  the  vehicle  is  considered  to  be 
driving  at  various  constant  speeds  when  the  vehicle  is  steered  by  a  parabola  to 
step  steering  input  It  is  intended  to  cover  a  realistic  range  of  operating  conditions 
of  the  vehicle. 

The  variable^  which  are  analysed  as  functions  of  forward  velocitv  include  pitch 
and  roll  angles,  lateral  velocity,  yaw  rate,  sideshp  angle  and  lateial  acceleration 
of  the  sprung  mass  and  shp  angle  of  the  wheels 

The  cornering  at  different  steering  angle  simulation  is  similar  to  tlie  one  pre¬ 
viously  described,  but  m  this  case  the  forward  velocity  is  kept  constant  and  laiger 
values  of  lateral  acceleration  a4e  obtained  by  performing  the  cornering  manoeu¬ 
vres  at  different  values  of  steering  angles 

In  order  to  investigate  the  nonlinearities  of  the  quantities  of  motion  m  relation 
to  road  disturbances,  their  behaviour  are  analysed  for  the  vehicle  driving  over  a 
sinusoidal  road  profile  with  various  amplitudes. 

3.2  Analysis  of  Simulation  Results 

It  has  been  a  traditional  practice  m  vehicle  dynamics  studies  [3.  G.  U]  to  divide 
the  quantities  of  motion  m  groups  according  to  which  aspects  of  vehicle  motion 
they  are  related  to.  As  a  result  of  this,  the  areas  of  performance,  handling  and 
ride  studies  have  been  established  Although  the  purpose  of  the  present  work 
IS  to  look  at  the  automoiive  vehicle  as  a  total  system,  these  divisions  aie  well 
consolidated  by  then  use  m  practice  and  also  they  can  be  very  helpful  m  iindei- 
standing  overall  vehicle  behaviour  and  the  lelationship  amongst  the  innumerable 
variables  of  motion. 

The  area  of  performance  studies  or  longitudinal  dynamics,  is  concerned  witli 
the  behaviour  of  the  vehicle  when  driving  straight  ahead  or  at  very  small  lateial 
accelerations.  Vehicle  handheg  or  stability  refers  to  a  vehicle's  behavioui  in  re¬ 
sponse  to  the  application  of  lateral  forces  and  yawing  moments  caused  by  steering 
inputs  and  vehicle  motion  It  is  also  concerned  with  vehicle  lateral  stability  when 
driving  straight  ahead.  Ride  studies  are  concerned  with  a  a  vehicle  s  beliavioui 
as  it  transverses  uneven  road  surfaces  Under  certain  operating  conditions,  these 
areas  can  be  studied  sepaiately,  as  has  often  been  the  case  However  the  coupling 
amongst  these  variables  n»ust  be  taken  into  consideration  under  other  conditions, 
especiailv  limit  manoeuvres  The  objectives  of  this  simulation  analysis  is  to  look 
at  these  couplings,  their  magnitude  and  nature 
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3.2.1  Definition  of  a  Driving  Envelope 

Tlie  concept  of  a  fl>ing  envelope  has  been  ojigmated  m  aeronautical  researcli  and 
It  refers  to  the  operating  range  of  an  airplane  in  terms  of  ns  speed  noiiiialK 
e'cpressed  in  iiiach  number,  and  the  altitude  taiige  wlncit  it  covers  A  ■iimilai 
concept  called  dnv  mg  range  has  also  been  used  iii  automotive  engineering  [6j  and 
it  usually  refers  to  the  range  of  lougitudm.'^l  and  lateiai  accelerations  and  foiwaid 
velocitv  in  which  a  car  cau  operate,  given  a  certain  road  condition 

In  the  present  case,  the  concept  of  driving  envelope  are  used  in  a  different 
manner  The  idea  is  to  define  an  operating  range,  or  set  of  operating  langes.  in 
which  a  linearised,  or  set  of  interrelated  linearised  conditions,  w'onid  still  be  valid 
and  therefore  amenable  for  control  design  and  analvsts  purposes  This  analysis 
IS  based  on  the  previous  stmuialton  results 

The  quantities  which  are  used  to  define  the  envelope  are  longitudinal  lateral 
and  vertical  quantities  Its  concept  is  diagrammatically  illustrated  ir  figure  b 
The  hgu'e  represents  the  limits  of  linear  validity  of  the  models  m  the  .V  Y  and 
Z  directions 


Figure  0.  Concept  of  Diiving  Envelope 

The  transient  manoeuvre  simulations  are  analysed  m  comparison  to  tli?  e.x- 
pected  behaviour  of  a  linear  system  resulting  from  an  eigenvalue-eigenvector  anal¬ 
ysis  around  the  corresponding  operating  points  Also,  m  order  to  allow  a  com¬ 
parison  between  the  various  linear  system  representation,  tliat  is,  eigenvalues, 
eigenvectors  and  svstem  matrices,  around  different  operating  points,  a  ceitain 
driving  condition  w-ill  be  taken  as  a  nfeience  conhguialion. 

The  steady-state  manoeuvres  will  be  used  to  obtain  the  static  and/oi  gain 
relationship  between  the  various  variables  of  motion  and  the  inputs  or  distui- 
bances  In  this  case  it  will  be  possible  to  analyse  the  stiength  of  the  coupling 
between  these  variables,  and  iiow  linear  this  coupling  is  This  anal/sis.  togethei 
with  the  previous  one,  allow  the  decision  of  a  range  of  operation  m  which  a  lineai 
repiesentalion  of  the  svstem  is  still  valid,  and  furtlier  studies,  such  as  model  older 
reduction,  coiitrollei  analysis  and  design  foi  active  systems,  etc  is  possible 
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3.2.2  Eigenvalue  Analyais  ^transient) 

The  analysis  oTthe  transtenc  motion  of  the  previous  simulation  runs  is  perfoimed 
based  oh  an  eigenvalue/eigenvector  analysis  of  the  matrices  of  the  linearised  sys. 
tern,  determinwi  at  certain  ^operating  conditions.  As  described  earlier,  motion 
quantities  are  divided  according  to  which  modes  they  are  associated  with  and  to 
which  they.coutribute  more  si^'*ficautly.  In  this  sense,  some  quantities  of  motion 
are  either  taken  into  consideration  or  neglected,  according  to  the  circumstances 
of  the  simulation  run. 

Steering  inputs  are  related  to  a  vehicle's  handling  behaviour  which  is  con* 
cerned  with  the  ability  .of  the  vehicle  to  change  directions  at  the  driver's  request 
and  to  maintain  directional  stability  at  various  operating  conditions. 

The  variables  of  motion  which  seem  to  undergo  significant  variation  during 
cornering  manoeuvres  include  sprung  mass  yaw  rate,  lateral  velocity  or  sideslip 
angle,  lateral  acceleration  and  roll  angle,  and  unsprung  masses  slip  angles.  Re¬ 
lated  quantities  which  are  important  for  the  motion,  and/or  stability  purposes, 
are  the  tyre  forces.  Figure  6  depicts  some  variables  of  a  typical  test. 


Figure  6:  Response  of  the  sprung  mass  to  a  steering  input 

Vehicle  directional  stability  characteristics  are  related  to  the  eigenvalues  of 
the  characteristic  equation  which  is  associated  with  the  handling  modes.  How¬ 
ever,  a  number  of  parameters  which  specify  a  vehicle’s  handling  behaviour,  and 
therefore  stability,  have  been  derived  from  simple  models  and  are  well  established 
and  understood  in  the  vehicle  dynamics  community.  For  handling  studies,  three 
parameters  play  a  central  role  in  dehning  vehicle’s  behaviour: 


•  front  cornering  stiffness  (gradient): 
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Table  5:  Handling  mode  frequencies  anu  damping  factors  as  function  of  forward 
velocity  for  2  tyre  models 


•  rear  cornering  stiffness  (gradient)  and 

•  location  of  the  vehicle’s  centre  of  gravity  in  relation  to  the  wheelbase. 

The  value  of  these  parameters  determine  a  vehicle’s  transient  and  steady>state 
characteristics,  as  well  as  directional  stability  properties  The  handling  mode 
characteristics  of  a  vehicle  are  shown  to  be  those  most  susceptible  to  variations  in 
operating  conditions.  The  of  mofton  which  seems  to  affect  the  handling 

characteristics  most  significantly  is  the  vehicle’s /onrard  vtlocHy.  The  eigenvalue 
analysis  of  the  Jacobian  of  the  nonlinear  vehicle  model  shows  that  for  the  vehicle 
driving  in  a  straight  line,  the  handling  motles,  yaw  rate  and  lateral  velocity  (or 
sideslip  angle,  because  forward  velocity  is  assumed  to  be  constant)  show  the 
following  behaviour  with  increased  speed: 

•  decrease  in  natural  frequency; 

f  decrease  in  damping  factor. 

This  situation  is  illustrated  in  table  5. 

Because  the  eigenanalysis  at  these  operating  points  results  in  the  full  set  of 
frequencies,  damping  factors  and  modes,  The  effects  of  steering  angle  aud  forward 
velocity  in  the  ride  and  performance  modes  is  also  obtained.  U  could  be  observed 
that  they  have  not  been  affected  significantly  by  forward  velocity  nor  steering 
angle  for  the  present  linear  tyre  model.  The  limiting  situation  for  using  the 
linearised  model  is  loss  of  adhesion  which  happens  due  to  load  transfer  effects. 
The  variable  of  motion  which  is  related  to  load  transfer  effect  and  therefore  should 
be  used  for  a  control  strategy  is  fatenif  acctltration. 

Traction  and  braking  inputs  are  associated  with  a  vehicles  performance,  lu 
the  case  of  the  present  model,  studies  are  affected  and  limited  due  to  the  lack 
of  engine,  transmission  and  braking  system  models,  since  the  dynamics  of  these 
subsystems  also  determine  vehicle  longitudinal  motion.  However,  it  could  b^ 
observed  that  ride  modes  are  exercised  by  performance  manoeuvres  and  that  the 
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\anation  of  wheel  loads  affect  vehicle  later^  stability  in  combined  manoeuvres 
Figures  7  and  8  represents  some  %ariables  of  motion  for  such  simulation. 


Figure  8:  Response  of  the  sprung  mass  to  a  deceleration  force 


Road  vertical  disturbance  simulations  are  aimed  at  testing  vehicle  ride  modes 
The  study  of  vehicle  ride  modes  assumes  a  contact  point  model  for  the  interaction 


between  tyre  and  road  m  the  vertical  direction.  This  situation  :s  equivalent  to  a 
lumped  parameter  rnodel  for  the  tyre  vertical  force  cliaracienstics.  One  sucli  test 
result  are  illustrated  in  figures  9  and  10. 


Figure  10:  Response  of  the  sprung  mass  to  a  road  input 
Analysing  the  inOuence  of  bump  height  for  the  same  speed,  it  can  be  observed 


that;  for.allvariables  of  motion,  the  changes  in  transient  behaviour  is  completely 
negligible.  <Oue,caimot  eyen  distinguish  to  which  height  the  simulation  refers  to. 
if  the  scale  of  the  y-axis  would  not  be  shown  "*). 

The  behaviour  of  the  sprung  mass  for  the  same  bump  height  and  for  three 
different  spwds  sliows  that,  irrespwtiveof  the  value  of  the  speed,  their  transient 
motion  after  t\\t  inputs  have  been  applied,  m  the  range  in  which  they  get  excited 
by  the  bump  input,  are  nearly  the  same,  in  terms  of  the  frequency  of  oscillation 
and  damping.  In  this  way.  verticsd  displacement  and  acceleration  and  pitch  and 
roll  angles  show  similar. behaviour,  for  all  three  speeds  for  each  one  of  the  bump 
Iieights. 

These  results  are  interesting  in  the  sense  that  they  confirm  that  the  nonlinear 
vehicle  model  does  not  present  significant  differences  in  its  transient  behaviour 
when  under  ride  mode  types  of  excitation,  in  terms  of  fortcard  speed.  Together 
with  the  previous  conclusion  concerning  the  effect  of  bump  height  and  constant 
speed,  these  results  provide  good  insight  into  the  use  of  the  linear  model  approxi* 
mation  of  the  nonlinear  vehicle  model  for  the  area  of  ride  performance.  It  is  worth 
noting  that  this  area's  main  concern,  from  a  control  point  of  view,  is  analysis  and 
design  of  controlled  suspension. 

3.2.3  Gain  Analysis  (steady*8tate) 

The  gain,  or  steady<itate  analysis,  is  intended  to  assess  the  level  of  coupling 
amongst  the  variables  of  motion,  the  amount  of  noolioearities  m  these  couplings 
and  also  to  determine  vehicle  directional  stability  parameters. 

For  this  analysis,  three  types  of  8teady*state  simulations  have  been  performed: 

•  cornering  at  constant  speed  with  various  steering  angles: 

•  cornering  with  constant  steering  angle  at  various  speeds; 

•  crossing  of  obstacles  with  sinusoidal  profile  of  different  heights,  and  at  dif> 
ferent  speeds. 

The  results  presented  in  the  table  6  are  pitch  and  roll  angles,  yaw  rate.  lateral 
velocity  and  acceleration,  sideslip  angle  and  slip  angle  of  the  wheels.  They  are 
calculated  as  a  function  of  the  steering  angle  for  the  constant  speed  manoeuvre. 
For  the  constant  steering  manoeuvres  the  same  quantities  as  above  are  calculated 
in  terms  of  forward  velocity. 

As  it  can  be  deduced  from  this  table,  all  variables  chosen  to  be  retained 
showed  to  be  affected  by  the  steering  input.  The  pitch  angle  showed  the  smallest 
influence  of  all.  This  result  confirms  the  widespread  practice  to  ignore  vehicle 
pitch  from  the  state  variables  in  handling  studies,  and  when  it  is  considered,  its 
effect  is  calculated  in  an  approximated  manner. 

It  also  confirms  real  vehicle  behaviour,  because  a  vehicle  does  not  suffer  large 
pitch  angle  variations  in  any  normal  operating  condition.  The  other  variables 
chosen  for  the  sprung  mass  movement,  yaw  rate  (u^),  and  lateral  velocity  m 
vehicle  body  (Vy),  and  slip  angle  (oj)  for  the  wheels,  are  the  main  quantities  in 
handling  studies  and  their  importance  for  handling  studies  is  obvious. 
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Table  6:  Steady*state  Gains 

For  the  remaining  variables  of  motion  related  to  vehicle  handling,  it  can  be 
seen  that  the  model  coupling  concerning  forward  velocity,  can  be  adequately 
described  by  linear  relations  for  vehicle  steady*state  behaviour.  This  can  have 
interesting  design  implications  from  a  control  point  of  view,  depending  which 
strategy  is  adopted  to  implement  the  coniiol.  If  forward  velocity  is  adopted  as 
a  system  panmettr,  the  fact  that  model  characteristics  change  in  a  linear  way 
for  the  steady*state  behaviour,  together  with  the  conclusions  already  made  about 
the  transient  behaviour,  may  allow  the  implementation  of  some  kind  of  adaptive 
control,  for  example,  as  a  function  of  vehicle  speed. 

The  sinusoidal  profile  obstacle  crossing  manoeuvres  are  discussed  next.  The 
objectives  of  these  simulations  are  to  verify  the  linearity  of  the  ride  modes  of  the 
vehicle  model.  From  a  large  number  of  simulation  generated  frequency  responses, 
it  could  be  observed  that  there  is  no  significant  influence  of  the  input  signal 
amplitude  in  the  vehicle  vertical  modes,  indicating  that  linear  approximation  are 
adequate  for  these  modes  as  indicated  by  figure  U. 

It  can  be  concluded  that  the  present  vehicle  model,  with  linear  relations  for 
the  spring  and  damper  of  the  suspension,  and  for  a  linear  vertical  tyie  behaviour, 
as  well,  can  be  adequately  represented  by  a  linearised  model,  concerning  ride 
modes  behaviour.  The  limiting  factor  in  this  case  being  the  loss  of  adhesion  or 
compression  of  the  tyre  beyond  the  assumed  linear  range.  These  results  show 
that  the  inertia  couplings,  in  this  model,  for  these  modes,  are  weak. 

3.2.4  Determination  of  a  Driving  Envelope  for  Linear  Control  AnaU 
ysis  and  Design 

The  discussion  about  a  driving  envelope  for  linear  control  analysis  and  design 
is  centred  at  the  previous  simulation  runs. 

The  areas  of  vehicle  behaviour  which  are  discussed  are  the  same  according  to 
the  division  established  for  the  simulation  runs.  The  eff'^cts  and  consequences  of 
considering  them  together  is  also  attempted  to  be  discussed. 

For  the  vehicle  ride  behaviour.  ^Mth  its  present  tyre  aud  suspension  models 
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Figure  11;  Frequency  Reeponre;  Amplitudes  0.05,  0.01  nad  0.0125  iii 

the  tenge  o(  v&lidity  of  linenr  behaviour  seems  to  be  limited  only  by  tlie  loss  of 
contact  of  the  wheels  with  the  road.  These  conclusions  are  based  on  the  results 
of  the  transient  and  the  steady-state  analysis  of  the  previous  simulations.  For  the 
transient  results  it  can  be  observed  that  there  is  no  significant  changes  in  vehicle 
transient  behaviour  as  the  levels  of  model  inputs  are  varied. 

Concerning  vehicle  performance,  not  many  conclusions  can  be  drawn  due  to 
the  limitations  of  the  present  model  powertrain  and  braking  system  dynamics,  as 
well  as  the  longitudinal  tyre  model  and  which  play  an  important  role  in  vehicle 
performance  mode  and  its  coupling  to  other  vehicle  modes,  most  notoriously  to 
vehicle  handling. 

Finally,  with  respect  to  the  handling  modes,  it  seems  that  for  a  linear  tyre 
model,  quite  adequate  linear  approximations  can  be  made  especially  for  low  value 
of  lateral  acceleration,  based  on  the  analysis  of  the  present  simulation  results. 

In  any  case,  linear  model  which  are  adaptive  with  vehicle  speed  seem  to  lie 
recommendable,  to  cuc'-escfully  implement  such  controls.  The  coupling  with  the 
ride  modes  have  been  previously  descnbed  and  it  does  not  seem  likely  that  a 
steering  control  would  ..feet  suspension  behaviour,  but  the  contrary  is  true 

4  Conclusions 

This  paper  has  discussed  the  importance  of  the  derivation  of  vehicle  chassis  mod¬ 
els  encompassing  all  aspects  of  vehicle  motion  in  order  to  allow  the  development 
of  integrated  vehicle  control.  It  has  proposed  an  approach  to  modelling  vehi¬ 
cle  suspension  which  is  based  on  simple  experimental  data  and  uses  concepts 
of  differential  geometry.  The  derivation,  simulation  and  analysis  of  the  model 
was  performed  using  the  computer  programs  SD/FAST.  ACSL  and  MATLAB. 


respectively.  The  model  has  been  validated  and  therefore  it  could  be  used  for 
simulation  analysis  aimed  at  obtaining  operating  ranges  m  which  linear  approx¬ 
imations  woould  be  valid.  For  the  present  model  it  can  be  concluded  that  the 
performance  and  ride  modes  are  not  affected  siguificantiy  by  variation  in  operat¬ 
ing  conditions  nor  the  steady-state  response  by  the  magnitude  of  the  inputs  The 
limiting  factors  for  these  aspects  of  motion  are  loss  of  tyre  contact,  the  handling 
modes  are  those  most  affected  by  changes  in  operating  conditions  and  the  variable 
of  motion  which  seems  to  have  the  largest  influence  is  vehicle  speed.  Ho^\eve^  it 
worth  noting  that  this  change  do  not  affect  other  modes  and  the  coupling  occur 
at  the  tyre  model  more  than  at  the  vehicle  body  model 
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Abstract 

This  paper  discusses  a  nusnrlcal  investigation  regarding  the 
effect  of  the  shock  absorber  daaping  turve  on  the  dynanic 
behavior  of  a  vehlcia  McPherson  suspension.  The  study 
focuses  on  the  suspension  behavior  in  the  vertical 
direction.  Both  single  hantonlc  and  pseudo-random  waveforms 
were  used  for  the  input  force.  The  vertical  force 
transmlasibllity  was  calculated  from  the  wheel  hub  to  the 
McPherson  dome  for  various  levels  of  the  forcing  function. 
The  results  provide  a  description  of  the  behavior  of  the 
suspension  unit  as  a  function  of  the  characteristics  of  both 
the  damper  and  the  force  input  to  the  system. 


1.  Introduction 

Automobile  suspension  units  Include  a  number  of  elements 
which  possess  nonlinear  characteristics  in  either 
displacement  or  velocity.  It  has  been  noted  that  correct 
modeling  of  these  nonlinear  characteristics  is  indispensable 
[1]  when  studying  the  dynamic  behavior  of  a  suspension  unit, 
and  hence  its  contribution  to  overall  vehicle  vibrational 
comfort.  It  has  also  been  shown  (2]  that  the  most  important 
nonlinearity  is  that  of  the  shock  absorber  damping 
characteristic.  The  importance  of  the  damper  has  stimulated 
a  number  of  studies  regarding  the  modeling  and  specification 
of  shock  absorbers  [3-9). 
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The  objective  of  the  present  study  is  to  quantify  the 
influence  of  the  damper  curve  on  the  vertical  force 
transmissibility  from  Che  wheel  hub  to  the  upper  dome.  The 
upper  McPherson  dome  was  chosen  as  the  output  measurement 
point  because  it  is  the  location  at  which  the  greatest 
static  and  dynasdc  forces  enter  the  car  body  from  the 
suspension  unit:.  The  vertical  direction  has  been  isolated 
for  the  purposes  of  this  study  because  it  is  the  principal 
vibrational  direction  for  an  automobile  on  a  typical  road. 


2.  The  model 

Figure  1  presents  a  McPherson  front  suspension  as  found  on 
small  to  medium  European  automobiles.  Figure  2  presents  the 
model  developed  for  this  study  which  consists  of  seven  node 
points  as  defined  in  Table  1.  Three  of  the  nodes  are  centers 
of  mass.  The  first  center  of  mass  is  that  of  the  lower  arm 
(ms),  the  second  is  that  of  the  hub/wheel/strut  assembly 
(in),  while  the  third  canter  of  mass  is  the  upper  half  of 
the  strut  assembly  (an) .  The  mass  and  Inertia  values  are 
listed  in  Table  2. 

Other  elements  of  the  model  are  the  linear  main  spring  ( Scs ) , 
the  damper  (c)  and  the  linear  translational  (Kix,  Xiy,  Kiz, 
X«x,  Uy,  K<z,  Xtx,  Try,  K7Z)  and  torsional  (Tix,  Tiy,  Tiz, 
Ttx,  Tsy,  T<z,  Trx,  Trz)  stiffness  parameters  of  the 

rubber  bushings  that  attach  the  suspension  to  the  ear  body. 
These  stiffness  values  sra  listed  in  Table  3.  The  model  also 
Includes  a  spherical  joint,  a  slider  joint  and  two 
cylindrical  joints  which  apply  the  kinematic  constraints  of 
the  suspension  design.  The  end  of  travel  snubbers  were  not 
modeled  in  this  study. 

The  force  input  to  the  model  was  applied  at  the  hub  (mi)  in 
the  vertical  direction.  The  force  output  was  measured  at  the 
McPherson  dome  in  the  vertical  direction,  which  corresponds 
to  the  force  transmitted  across  the  vertical  stiffness  Kiz. 
The  suspension  unit  is  not  attached  to  the  vehicle  in  the 
present  study  but  rather  to  ground  (Figure  2).  The  model 
simulates  a  bench  test  in  which  the  suspension  attachment 
points  are  mounted  to  a  rigid  fraiw. 

Figures  3  and  4  present  the  three  damping  curves  considered. 
The  damper  of  Figure  3  is  representative  of  a  medium 
European  automobile  and  will  hence  be  referred  to  as  normal 
production.  The  damper  setting  is  highly  asymmetric, 
producing  most  of  the  damping  force  in  the  rebound  stroke 
(positive  velocity).  This  damper  curve  can  be  divided  into 
two  regions  indicated  as  I  and  II.  If  we  define  the  viscous 
dampirt  coefficient  as 
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Figure  2)  McPherson  front  suspension  model. 


where  £  is  the  instantaneous  force  and  v  the  instantaneous 
velocity  of  the  ahsorber,  we  can  describe  the  curve  used  in 
this  study  as  having  a  varying  daoping  coefficient  in  region 
X  but  constant  daoping  coefficients  in  region  11. 

The  second  daoping  curve  studied  (Figure  4)  was  linear,  and 
was  derived  froo  the  noroal  production  curve.  A  linear  least 
squares  interpolation  was  performed  to  obtain  a  constant 
daoping  coefficient  equal  to  the  average  of  the  normal 
production  damper  over  the  velocity  range  of  interest.  A 
correction  (shift)  was  performed  so  as  to  produce  zero  force 
at  the  origin. 

The  third  daoping  curve  (Figure  4)  is  bilinear.  It  is 
obtained  by  rotating  the  two  halves  of  the  viscous  damper  by 
a  constant  but  opposite  angle*  This  rotation  maintains  the 
same  area  under  the  damping  curve,  but  introduces  a 
discontinuity  at  the  origin. 

The  three  damping  curves  chosen  are  different  in  nature,  but 
remove  similar  amounts  of  jeinetio  energy  in  the  velocity 
interval  of  this  study  (0  to  1.2  m/s). 


3.  Inputs  studied 

Two  types  of  force  input  were  chosen.  The  first  was  single 
harmonic  input  (sine)  and  the  second  was  a  band-lioitsd 
psaudo-randoo  signal  (Figure  5).  The  frequency  range  of 
study  was  from  0  to  50  Bz.  The  force  levels  chossn  were 
representative  of  typical  operating  loads. 

Barmonic  input  was  chosen  for  two  reasons.  The  first  is  that 
a  single  steady  state  harmonic  oscillation  permits  a  simpler 
evaluation  of  system  nonlinsarities.  There  are  many  studies 
in  the  related  literature  which  utilize  this  approach  [10- 
14 ) .  The  second  reason  for  choosing  a  harmonic  input  is  that 
there  exist  road  inputs  such  as  long  road  undulations  which 
are  similar  in  nature. 

Eight  seconds  of  time  domain  integration  wore  performed  with 
each  sinusoidal  force  input  in  order  to  obtain  the  system 
response.  The  integration  time  step  utilized  was  512  points 
pet  second.  One  hundred  frequencies  were  evaluated  in  the 
range  from  1  to  50  Bz.  Five  different  peaJt  force  amplitudes 
were  also  utilized.  For  the  three  damper  characteristics 
studied  this  gives  a  total  of  1500  integration  runs. 
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The  pseudorrandom  .force  input  was.  chosen  .so-  as-  to  have  a 
band-limited  alteEnatiye  to  .single  harmonic  input.  Host  road 
inputs ‘have' significant  content  over,  a, wide:  frequency  band'. 
The  fre'quehcy  content  of  ^this  input, covered  the  “range  from  0 
t3  50  Hjs-,'  'with'-'.'qne.  •frequehoy,.' line  every,  .125,  ,B2,'  and 
randomized -phases:  '’Seven  !<iiffereht-. RMS  levels  were  created 
by  first  generating'  a-‘baae  "signal,  then  multiplying  it  by 
six  constant  values . ^This , had  .the. effect .of  changing- the- RHS 
level  whilef.maintainihg  .thi:  crest  factor  (3.95)  and  phase 
relationships' unalberadl  .An'.example  of  -pseudo-random  force 
input  is  '.presehted  in  Figure  5. 

As  in  the  case  of  single  Harmonic  input,  eight  seconds  of 
time  domain  integration  were  performsd  with  a  time  step  of 
512  points  per  second.  Seven  different  RMS  force  levels  were 
utilized.  -For  the  three  dampers  studied  this  gave  a  total  of 
21  integration  runs. 


4.  Renults 

The  model  of  Figure  2  was  assembled  and  solved  with  the 
ADAMS  (Appendix  1)  program  for  the  various  Inputs  studied. 
The  behavior  of  the  su^ipenaion  unit  was  studied  by 
calculating  the  gain  of  the  force  transmissibllity  in  the 
vertical 'direction  from  the  bub  (mj)  to  the  McPherson  dome 
(Kiz  stiffness).  The  gain  was  defined  in  two  ways.  For  the 
case  of  single  harmonic  force  input  the  gain  was  defined  as 


Gain 


(2) 


where:  y  ■  maximum  output  force 

X  m  maximum  input  force 


For  the  case  of  the  band-limited  pseudo-random  force  input 
the  gain  was  chosen  as 

!  1 

Gain  •  |  Hi(o)  |  -  (3) 


where:  Sxy  "  cross  power  spectral  density 
Sxx  •  input  power  spectral  density 


Of  Che  .possible^  esCimaCea  foe  the  frequency  response 
function,/,  .thes  Hj'- ’estimator  <waa -'chosen  because"  it  produces 
the  best's uribiase'djlihear .''modeirdf '-the 'system 't  15),  in  absence 
of 'noise,<on 'the'? input'.'  Thia'?oharadt'eristi'c..is  Appropriate  -in 
the  present-,,  study.'.beoause;  the  Unput  fo'rc'e  is '  s'peoified,  with 
noise'  due  tojehergy  trana'fer!'pres«ic'.‘phly  oh  the'  oiitput. 

Fi^re«6;,prasehta>’tha;  force, ',gain'  of  the,  suspension  in  the 
vai^icai '.^direction:' .for  each-  o'f  'ther.thrae  'dampers  when 
subjected  {to  ^single  «baniionie<'  force'  input's,  of  different  peak 
aiiplltude  level.  The  results  ontained'  with'  the'  linear'  damper 
Indicate  that  the  entire  model  is  basically  linear.  The 
geometrical;  tnonlinearlties-  were'  fouh<l';{,to‘^  be  small,  for  the 
auspansion> .rotations  Induced  (±3'  degrees).  The,  situation 
changes'  somewhat  in  the  case  of  the  bilinear  damper,  where 
nonlinear  effects  are  '  now  visible  in  the  immediate 
neighborhood  of  the  main  suspension  resonance  (2.95  Hz). 

The  most  pronounced  nonlinear  affects  are  produced,  however, 
by  the  noraal  production  damper  (Figure  6-e).  Two  basic 
types  of  behavior  are  Immediately  visible.  The  first  type 
regards:  those  integration  runs  in  which  the  achieved 
velocities  of  the-  damper  wars  confined  to  only  the  first 
region  ,of  the  da^iiag  curve,  that,  in'  which  the  viscous 
damping  , coefficient  Varies.  For  region  I  oscillations. 
Increases;  of  the:  input  force  produce,  an  Increase  in  the 
harmonic  content  of- the  transmitted' fore's.  The  hanunlcs  add 
to  the  transmitted  force  at  the  driving  frequencies  thus 
increasing  the  system  gain  as  calculated  by  equation  ( 2 ) . 
The  second  type  of  behavior  is  produced  when  the  damper 
works  for  significant  periods  of  time  on  both  the  first  (I) 
and  second  (II)  regions  of  the  damping  curve.  In  t)>is 
situation  the  system  gain  becomes  more  linear  as  tbs  input 
level  rises  (using  more  of  the  region  of  constant  viscous 
damping  ratio) . 

Another  representation  of  the  behavior  of  the  suspension 
unit  when  subjected  to  single  harmonic  input  is  provided  by 
Figure  7,  which  presents  acceleration  response  spectra  of 
the  hub/wheol/strut  assembly  when  subjected  to  3  Hz 
sinusoidal  force'  input.  Spectra  are  presented  for  both  the 
bilinear  and  normal  production  dampers.  The  Figure  plots  the 
ratio  of  the  acceleratloh  response  to  the  peak  force  as  a 
function  of  both  frequency'  and  peak  force.  For  the  normal 
production  damper,  the  growth  of  harmonics  with  increasing 
input  level  is  evident  from  the  spectra  for  the  sinusoidal 
force  inputs  of  250,  500  and  750'  Hewtons.  The  reduced 
harmonic  content  of  the  acceleration  response  when 
oscillating  in  both  region  I  and  II  is  visible  in  the  data 
relative  to  the  1000  Hewton  input  force.  Two  further  points 


Figure  7)  Non&aXized  acceleration  spectra 
of  the  hub/wheel/stnit  assembly 
when  subjected  to  3  Hz  single 
harmonic  input* 

a)  bilinear  damper 

b)  production  damper 


Figure  8)  Vertical  force 
transmissibility 
of  the  suspension 
when  subjected  to 
pseudo-randoa  input. 

a)  linear  daaper 

b)  bilinear  daisper 

c)  production  deunper 
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o£  interest  relative  to  the  data  of  the  normal  production 
damper  are  the  reduction  in  even  order  harmonics  with 
increasing  input  force  and  the  reduction  in  average  damping 
level  with  increasing  amplitude  of  the  input  force. 

Figure  8  presents  the  vertical  gain  of  the  suspension  when 
exposed  to  the  band-limited  pseudo-random  force  input.  Use 
of  this  input  and  of  the  HI  estimator  for  the  system  gain 
have  provided  clear  evidence  of  the  energy  transfer  from  the 
system  main  resonance  to  both  odd  and  even  order  harmonics. 
The  harmonics  are  more  strongly  excited  in  the  case  of  the 
bilinear  damper  than  in  the  case  of  the  linear  damper,  where 
the  nonlinearity  is  only  geometric.  For  the  normal 
production  damper,  all  harmonics  of  the  suspension  main 
resonance  are  clearly  visible  in  the  response  up  to  9th 
order.  The  pseudo-random  results  confirm  the  previous 
observations  regarding  the  two  principal  regimes  of  behavior 
with  the  normal  production  damper. 


5.  Transition  points 

In  the  present  study,  the  transition  from  region  I  only  to 
region  I  and  ZI  oscillation  plays  an  important  role  in  the 
behavior  of  the  suspension  with  the,  normal  production 
damper.  The  results  indicate  that  the  suspension  behaves 
very  nonlinearly  when  oscillating  below  the  transition 
points,  but  becomes  more  linear  as  oscillations  explore  more 
or  region  II  beyond  the  transition  points. 

Figures  9  and  10  present  the  probability  density  function 
(PDF),  cumulative  density  function  (CDF)  and  damping  curve 
for  the  two  types  of  oscillation  identified.  Figure  9  is 
representative  of  a  region  I  only  oscillation  while  Figure 
10  representative  of  a  region  1  and  II  oscillation.  The 
second  example  remains  for  a  significant  number  of  time 
steps  on  region  IX  of  the  damping  curve. 

Thtf  authors  propose  that  the  reduced  harmonics,  and  more 
linear  behavior  of  the  suspension  with  increasing  amplitude 
of  the  force  input  is  to  be  attributed  to  the  increasing 
usage  of  the  linear  segments  of  the  damping  curve  (reg3.on 
II).  While  region  I  oscillations  are  exposed  exclusively  to 
a  nonlinear  damping  law,  region  I  and  II  oscillations  are 
exposed  to  linear  dashing  for  a  portion  of  the  cycle  that 
increases  as  the  force  amplitude  increases. 
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Figure  9)  Probidbility  density  function#  damping 
curve  and  cumulative  density  function 
for  a  region  X  only  oscillation. 


Figure  10)  Probediility  density  function,  deuaping 
curve  and  cumulative  density  function 
for  a  region  I  and  II  oscillation. 
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6.  Conclusions  and  recoRunendatLons 

Recent  research  has  indicated  that  the  shock  absorber  is  the 
ma^or  cause  of  the  nonlinear  behavior  of  automobile 
suspensions  in  the  range  from  0  to  50  Bz.  The  present  study 
has  investigated  the  effect  of  the  damping  curve  on  the 
vertical  force  transmitted  from  the  hub  to  the  dome  of  a 
McPherson  suspension  unit. 

The  vertical  force  transmissibility  from  hub  to  dome  for  the 
case  of  the  linear  damper  has  sho%m  that  the  geometrical 
nonlinearitiea  are  small  in  the  range  of  input  forces 
studied*  The  vertical  force  transmissibility  with  the 
bilinear  damper  was  found  to  be  similar  to  that  of  th"* 
linear  damper,  but  with  n  stronger  harmonic  content. 

The  normal  production  damper  was  found  to  produce  a  wide 
range  of  auepension  characteristics  depending  on  the  level 
and  type  of  input.  This  damper  produced  highly  noticeable 
harmonies*  The  results  sugges^  that  the  location  of  the 
transition  points  from  region  I  to  region  II  of  the  damping 
curve  plays  an  important  role  in  determining  the  overall 
characteristics  of  the  suspension  unit.  The  results  also 
suggest  that  the  harmonic  content  of  the  suspension  response 
is  very  sensitive  to  the  local  variation  of  the  viscous 
damping  coefficient,  the  strongest  harmonics  being 
specifically  associated  with  the  regions  of  highest 
variation  in  the  viscous  damping  coefficient* 

Areas  of  future  study  include:  performing  a  detailed 
investigation  of  the  energy  transfer  mschanisns  of  the 
current  suspension  model,  investigating  the  effect  of 
introducing  end  of  travel  snubbers  to  the  current  suspension 
model,  and  adding  a  tire  model  and  quarter  car  free  mass  so 
as  to  investigate  how  the  shock  ^sorber  influences  the 
force  input  produced  by  known  road  profiles.  These 
activities  will  further  the  knowledge  of  suspension 
behavior,  thus  making  easier  the  interpretation  of  the 
complex  data  generated  by  complete  vehicle  models  and  tests* 


APPEMDIX  1 

The  object  of  this  Appendix  is  to  describe  in  very  broad 
terms  the  operation  of  the  ADAMS  program*  ADAMS  is  an 
environment  for  building  and  solving  models  of  multibody 
(lumped  parameter)  mechanical  systems.  An  ADAMS  model  is  a 
data  set  describiig  the  geometry  of  a  system,  the  mass  and 
inertia  of  its  components,  its  stiffness  and  damping 
properties,  the  boundary  conditions  (constraints)  and  the 
system  inputs*  The  data  is  used  to  assemble  a  system  of 


soo 


equations  by  applying  the  equations  of  motion  of  Lagrange  to 
each  mass  of  the  system 


d 


dt 


aq:J 


dL 

aqj 


i=l 


a4i 

SqJ 


Xi  =  FJ 


for 


l,..n  (Al) 


*1  =  0  (A2) 


where  L  •  the  Lagrangian  (T-V) 

T  »  kinetic  energy 

V  =  potential  energy 

q  •  vector  of  generalized  coordinates 

F  •  vector  of  externally  applied  forces 

*  »  vector  of  rigid  constraints 

X  •  vector  reaction  forces  due  to  the  constraints 


Equations  A1  and  A2  describe  a  constrained  equilibrium  of 
the  form 


(A3) 


where  IF  and  *  ace  nonlinear  functions  of  the  system  states,, 
the  Lagrange  multipliers  and  the  time  step 

IF  -  f(q,q,q,X,t) 

*  “  f(q,q,t) 

The  second  order  terms  in  equation  A3  are  reduced  to  first 
order  by  the  introduction  of  a  new  dependent  variable 


IF 

q-U 

* 


-  M 


{A4) 


where  u  is  a  vector  of  generalized  velocities.  Therefore  the 
sum  of  force')  tens  of  equation  A4  becomes 
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ZF  »  f(U,q,q,X,t) 

The  above  formulation  produces  a  set  cf  differential  and 
algebraic  equations.  These  equations  are  solved  by  utilizing 
a  Gear  predictor "corrector  algorithm 

The  predictor  operations  estimate  the  system  response  at  the 
next  time  step  (n-fl)  baaed  on  the  response  at  previous 
points.  A  polynomial  of  order  k  is  fitted  to  the  previous 
values  of  the  system  states  of  each  of  the  generalized 
coordinates  of  the  system,  and  the  polynomial  thus 
calculated  is  used  to  evaluate  a  truncated  Taylor  series 
expansion  to  obtain  the  system  response  at  time  nti 


ayn  1  a  yn  2 

yn.l  =  yn  -  ,A5, 

where  y  is  the  systen  state  and  h  is  the  integration  time 
step.  li  the  estimate  of  the  system  states  does  not  satisfy 
the  equilibrium  condition  of  equation  A4  to  the  desired 
error  tolerance,  oorrector  operations  are  applied  to  adjust 
the  stats  variables. 

Corrector  operations  begin  by  utilizing  the  estimate  of  yn.l 
obtained  by  the  predictor  to  fit  a  new  k  order  polynomial  to 
the  generalized  coordinates.  This  new  polynomial  is  used  to 
evaluate  the  derivative  at  time  n+l,  which  is  then  used  to 
obtain  the  new  estimate 


-h  eo  yn+i  + 


I  «J  Yn-j+X 

J»1 


where  0o,aj  are  the  Gear  integration  coefficients.  The  above 
implicit  equaticn  is  Iterated  until  the  solution  satisfies 
the  specified  error  tolerance. 

The  solution  of  the  system  equations  provides  all  the 
forces,  velocities  and  accelerations  that  define  the 
boundary  equations  of  the  system  masses. 


LI 
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ABSTRACT:  This  paper  pruuits  i  muhodolojy  m  compuuiionil  dynamics  for  ihe  analysis  of 
mechanical  systems  that  undergo  intermittent  inouon.  A  canonical  form  of  the  ’.'oiiauons  of  mouon  is 
derived  with  a  minimal  set  of  coordinates  and  these  equations  are  used  in  a  procedure  for  balancing  the 
momenu  of  the  system  over  the  penod  of  impact,  calctilatmg  the  jump  in  the  body  momenta,  velocities 
discontinuiQcs  and  lebounds.  The  effect  of  diy  faction  is  discussed  and  a  contact  law  is  proposed ,  The 
present  formulauon  u  extended  to  open  and  closed  loop  mechamcal  systems  where  the  jumps  m  the 
constramfs  momenta  are  also  solved.  The  applicaaon  of  this  methodology  is  lUustraied  with  the  study  of 
impaa  of  open  loop  and  dosed  loop  examples. 


1.  Introduction 


Impact  occurs  in  many  mechanical  systems,  such  as  crushing  and  feeding  machinery. 
This  muiubody  systems  undergo  intermittent  motion  essennally  charactenaed  by 
disconnnumes  they  encounter  when  two  bodies  within  these  systems  collide. 

The  use  of  the  canonical  form  of  equanons  of  monon.  in  impact  analysis  involving 
impulse  and  momentum  variables,  has  been  presented  in  several  text  books!  1-3),  where 
solunons  are  obtauied  for  velocity  changes  during  impact  of  particles  and  simple 
examples  of  ngid  body  collisions.  The  problem  is  more  complex  for  kinettcally 
cofsttained  mechanical  systems,  once  the  change  in  momenta  and  velocities  are  not 
solely  due  to  the  impulsive  forces  of  the  colliding  bodies  but  also  mvolve  the  changes  m 
the  rcacnons  of  the  idnemadc  constraints. 

Piecewise  analysis  formulations  have  been  developed  for  the  solutions  of  the 
rebounds  in  the  uitettnittent  monon  of  the  mechamcal  systems  [4-6],  Dtituig  the  penod 
of  the  rnipact.  the  integration  of  the  equanons  of  monon  is  halted  and  a  momennira 
balance  analysts  is  performed  to  calculate  the  velocity  jumps.  Impulsive  forces  ate  a 
byproduct  of  these  calculations.  In  these  methods  it  is  assumed  Urn  no  significant  change 
in  the  system  configuranon  occur  during  the  collision  time  which  is  considered  small 
compared  to  a  typical  ti.-iie  scale  of  the  monon  before  and  after  the  unpact 

Lankarani  and  Nikravesh  [7]  solved  the  direct  central  fricnon  ■  npact  of  a 
mechanical  system  using  a  canonical  form  of  the  equations  of  monon  expressed  m  tenns 
of  a  large  set  of  a  Cartesian  variables.  The  work  presented  here  starts  from  that  Cartesian 
canomcal  form  of  the  equanons  of  monon.  then  the  equanons  are  converted  to  a  mmimal 
set  of  equanons  in  terms  of  a  set  of  joint  coordinates  and  associated  generalized 
momenta. 


The  resulong  fonnulaaon  together  with  a  proposed  contact  law  coiiesponduig  to  the 
genual  oblique  impact  problem  between  two  bodies  of  a  mulnbody  system  is  applied  to 
some  examples.  The  role  of  the  coefficient  of  resomnon  and  the  coefficient  of  mcnon  is 
discussed  and  a  methodology  is  suggested  to  establish  the  condiuons  whether  or  not 
sliding  or  sdcnon  can  take  place. 


2.  Equations  of  motion 

The  equanons  of  monon  can  be  descnbed  in  terms  of  different  sets  of  coordinates.  If  the 
number  of  generalized  coordinates  is  greater  than  the  number  of  system's  degrees  of 
freedom,  then  algebraic  equations  are  required  to  show  the  dependency  of  the 
coordinates.  One  such  set  of  coordinates  which  leads  to  defimng  algebraic  constraints 
for  the  kuiemanc  joints  is  the  so  called  absolute  cartesian  coordmates  (81. 

Another  set  of  generalized  coordinates  which  can  provide  a  mimmal  set  of  equanons 
IS  known  as  the  joint  coordinates.  In  the  following  sections,  the  equations  of  monon  in 
turns  of  the  joint  coordinates  are  discussed. 

2.1.  STANDARD  FORM 

In  order  to  specify  the  posinon  of  a  ngid  body  in  a  global  non-moving  XYZ  coordinate 
system,  it  is  sufficient  to  specify  the  spanal  locanon  of  the  ongin  (center  of  mass'  a-.d 
the  anguiar  onentanon  of  a  body  fixed  coordinate  system.  For  the  ith  body  in 
multiMy  system  qi  denotes  a  vector  of  coordinates  whtch  contams  a  vector  of 
nansianonal  cooidinates  ri  and  a  set  of  rotadonal  coordinates.  Manx  At  represents  the 
rotational  transformanon  of  the  ^iqiCi  axes  relauve  to  the  XYZ  axes.  A  vector  of 
velocities  for  body  i  is  defined  as  vj,  which  contains  a  three  vector  of  translational 

velocines  ri  and  a  three  vector  of  angular  velocines  taj.  A  vector  of  acceleranons  for  this 
body  IS  denoted  by  vj  which  contains  rj  and  6)|.  For  a  mulnbody  system  containuig  b 

bodies,  the  vector  of  coordinates,  velocines  and  accelerations  are  q,  v,  and  v;, 
respeenvely,  for  body  i»l.l...,b.  Also  a  generalized  mass  manix  is  denoted  by  IW  and  a 
vector  of  generalized  forces  g  is  defined  for  the  mtildbody  system. 

The  relative  configuranons  of  two  adjacent  bodies  can  be  defined  by  one  or  more  so- 
called  joint  coordinates  equal  in  number  to  the  number  of  relauve  degrees  of  freedom 
between  these  bodies.  The  vector  of  coordinates  for  an  open  loop  system  is  denoted  by  0 
containing  all  of  the  joint  coordinates  and  the  absolute  cooidinates  of  a  base  body  if  the 
base  body  is  not  the  ground.  Therefore,  vector  9  has  a  dimension  k,  equal  in  number  of 

the  degrees  of  freedom  of  the  system.  The  vector  of  joint  velocines  is  defined  as  9 .  It 
can  be  shown  that  there  is  a  linear  transformanon  between  9  and  v  as  (9-1  Ij. 
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A'here  B  is  a  nxk  mamx.  When  the  number  of  selected  coordinates  is  equal  to  the 
number  of  degrees  of  freedom,  the  generalized  equations  of  motion  for  an  open  loop 
muiubody  system  can  be  written  as 

M0  =  f  (2) 

where 

M  =  B  (3) 

f  =  B’^(g-.VB8)  (4) 

In  order  to  solve  these  equations,  a  set  of  imtial  conditions  must  also  be  defined  as 

6(0)  =  6’’,  6(0)  =  6°  (5) 

Assume  that  there  are  one  or  more  closed  kinematic  loops  m  a  muiubody  system.  To 
derive  the  equauons  of  mouon  for  such  a  system .  each  closed-loop  is  cut  at  one  of  the 
kinemauc  joints  in  order  to  obtain  an  open-loop  system  without  derining  any  joint 
coordinates  for  the  cut  joints.  Therefore,  vector  of  joint  coordinates  6  has  a  dimension  k 
greater  than  the  number  of  degrees  of  fteedom  of  the  closed-loop  system.  If  the  cut 
joints  are  reassembled,  the  joint  coordinates  are  no  longer  independent  Therefore,  there 
exist  algebraic  constraints  between  the  joint  coordinates  as  [12]. 

4'(6)»0  (6) 

The  first  and  second  nme  denvauves  of  the  constraints  are 


'{'■06  =  0  (7) 

'i'»C8  +  C8  =  0  (8) 

where  C  is  the  Jacobian  matrix  of  the  constraints.  Then,  the  differennal  equauons  of 
mouon  of  Eq.  2  are  modified  as 

Me-C'''v  =  f  (9) 


where  v  is  a  vector  of  Lagrange  mulupliers. 

Eqs.  6-9  represent  a  set  of  differennal  algebraic  equauons  for  a  closed  loop  sysrem.  A 
set  of  iniual  condiuons,  such  as  the  set  given  by  Eq.  5,  but  consistent  with  the  const -amts 
of  Eqs.  6  and  7.  must  also  be  defined.  These  equauons  can  further  be  reduced  to  a 
minimal  set  of  second  older  differennal  equations,  equal  m  number  of  the  degrees  of 
fieedom  of  the  system  (12). 

2.2.  CANONICAL  FORM 

The  equauons  of  mouon  for  a  muiubody  system  can  also  be  derived  tn  teims  of  the  total 
momenta  of  the  system.  The  process  of  convemng  the  equauons  of  mouon  desenbed  m 
teims  of  a  large  set  of  absolute  accelerauons  to  a  canomcal  form  has  been  shown  in  (7J. 
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In  order  to  transform  the  open  loop  equations  of  motion  of  Eq.  2  to  the  canonical 
form,  a  vector  of  joint  momenta  p  is  defined  as 


p  =  f4.M0  (H) 

Eq$  10  and  1 1  form  a  simultaneous  system  of  2xk  diffennoal  equanons  of  the  first  order 
which  can  be  considered  as  the  solution  of  the  Lagrangean  problem  assuming  that  d  and 
p  are  vaned  independently  of  each  other  (13).  For  these  equanons.  an  appropriate  set  of 
imnai  condinons  must  be  defined  as 

8(0)  =  6“,p{0)  =  p®  (12) 

For  closed  loop  systems  a  number  of  presenbed  scleronomic  condinons  may  be  given 
by  Eq.  6  and  a  mixed  representanon  eoiresponding  to  die  general  canomc  iransfoimanon 
IS  defined  as  (13| 

M8-C’''a  =  p  (13) 

where  vector  of  Lagrange  muldpliets  o  ts  defined  as  o  =  v.  The  nme  denvanve  of  Eq. 
13  yields 

p  =  f  +  !VI8-C’'(J  (14) 

Equations  13  and  14.  in  conjunction  with  Eqs.  6  and  7.  provide  the  constrained  et^uanons 
of  moQon  in  canonical  form.  A  proper  set  of  inida)  conditions  such  as  the  set  given  by 
Eq.  12  and  consistent  with  the  constraints  of  Eqs.  6  and  7  are  also  required. 

Numencal  soluaon  of  the  canonical  equauons  of  motion,  for  either  an  open  or  a 
closed  loop  system,  can  be  obtained  by  introducing  integranon  anays  as 


At  every  integration  time  step.y  array  is  integrated  to  obtain  y.  For  open  loop 
systems,  vector  9  is  used  to  determine  the  absolute  coordinates  q.  then  vector  p  is  used  to 

obtaind  andthen  vis  found  fioraEq.l.Eq.U  yields  p.  which  in  addition  to  6  provide 

all  the  elements  of  y  in  order  to  conanue  with  the  integration. 

For  closed  loop  systems,  vector  6  is  found  from  the  solution  of  Eqs.  7  and  9,  where  o  is 

also  found  at  the  same  time.  Then  Eq.  14  is  used  to  find  p.  The  rest  of  the  process  is  the 
same  as  that  of  the  open  loop  systems.  A  possible  problem  with  this  procedure  is  that  due 
to  the  accumulation  of  numerical  errors  during  integrabon.  the  po.smon  constraints  of  Eq. 
6  may  become  violated.  Different  techniques  for  eliminating  the  possibility  of  constraint 
violauon  can  be  found  in  (8). 
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In  a  piecewise  impact  analysis,  it  is  assumed  that  the  contact  between  points  Pi  and  Pj 
lasts  for  a  shon  period  from  t(")  to  during  which  the  configuranon  of  the  system 
does  not  change.  As  a  result,  the  dynamics  of  the  open  loop  and  closed  loop  systems  are 
governed  under  this  smoothness  assumption  by  Eqs,  10  and  11  and  Eq.  13  and  14, 
respectively.  A  contact  -impact  law  involving  the  relative  velocity  Vf  and  the 
generalized  forces  f  must  also  be  provided. 


3.  Points  ofContact  and  Relative  Velocities 


Assume  that  an  impact  occurs  between  bodies  i  and  j  of  a  mulQbody  system.  The  relanve 
velocity  between  the  points  of  contact  Pi  and  Pj  is  written  in  terms  of  the  absolute 
velocmes  of  these  points  as 


(16) 


where  Oij  is  a  3xn  incidence  mamx  and  it  is  a  function  of  the  coordinates  of  bodies  i 
ar.d }  only.  Substituting  Eq.  1  into  £q.  16  yields 


Vf«R6  (17) 

where  R  a  Oy  B  is  a  3xk  mamx  dcscnbing  ad  dependent  linear  mapping  of  the 
generalized  velociaes. 

The  relative  velocity  vector  Vf  is  represented  by  its  components  rclauvc  to  some 
chosen  onhononnal  base  (n.  ti,  <2) 

We  shall  assume  that  the  unit  vector  n  is  defrned  in  the  normal  direction  to  the  contact 
surfaces  and  ducted  towa^  body  i.  A  schematic  representation  of  the  contact  between 
b^es  1  and  j  IS  shown  m  Fig.  1. 

The  com^nent  of  vector  Vf  along  the  normal  direction  is 


v„  =  n'’'v,n 
»  n^(R9)n 

»(cjf9)n  (18) 


whexe 

cJ  =  n’'R  (19) 

is  a  k  vector.  The  tangential  component  of  Vf  corresponding  to  the  slip  velocity  is 
denoted  as  vt  and  lies  m  the  langenaal  plane  ( ti,  12).  perpendicular  to  n  such  that 


(20) 
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Figure  t.  Impact  of  multxbody  systems 


At  and  tW  the  relative  velocity  vectors  are  denoted  by  vj-C*)  and  vr^'*’) 
ifspecQveiy,  The  normal  components  of  these  vccton,  vn^’)  and  are  colhncar 
along  n.  However,  their  tangential  components,  vi(')  and  are  not  nccessanly 
coUincar.  Velocity  jumps  arc  defined  as  Avr »  •  Vr(')  ,  Avn  =  vn^'*’  ^ 

and  Av( «  V|(+)  -  vp*). 

A  coefficient  of  resatuaon  m  the  normal  direction  is  introduced  as  the  rauo  between  the 
relaavc  separation  veloaty  and  the  reianve  approach  velocity  as 


e  » 


v«_  ejew 


(21) 


The  introduction  of  the  intnnsically  non^negadve  value  of  e  has  been  traditionally 
associated  with  the  loss  of  kinenc  energy  tn  impacts  m  which  the  tangennal  component 
of  impulse  is  absent  This  occurs  when  the  contacting  surfaces  are  perfectly  smooth  or  m 
direct/oblique  and  central/eccentnc  impacts.  The  explicit  use  of  e  as  a  Idnemanc 
constramt  is  extended  for  the  analysis  of  more  general  impact  situations  playing  a  rote  of 


sto 


! 

L 
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The  generalized  impulse  vector  tc  due  to  impulsive  forces  is 


(28) 


*  CnSfl  +€#31* 


where  irn  and  ict  are  the  normal  and  the  tangonnal  impulses  due  to  impulsive  forces 
and  fi('l  acting  m  the  normal  and  tangenual  directions,  rcspecuvely. 

The  method  of  obtaining  the  generalized  impulsive  forces  /('>  and  the  generalized 
impulse  n  through  the  linear  mappings  Cn  and  C|  suggests  the  usual  concept  of  vinual 
monons  at  fixed  ume  and  expressed  as  a  faimly  of  configuranons  B  (e)  depending  on  a 
real  vanabie,  e,  in  a  differenoable  manner,  with  subsequent  calculanons  made  at  coiaami 


5.  Open  Loop  Systems 

From  Eq.  10  the  generalized  velocity  jumps  can  be  obtained 

<16  =  M’‘<lp  (29) 

Integraung  the  canonical  equations  of  motion  desenbed  by  Eq.  1 1  for  the  period  of 
contact,  the  generalized  impulse  vector  dp  is  given  as 

.(W  ,!<*)  . 

<lp  =  J^(,,  f  dt  +  J^(,  MBdi  (30) 

The  generalized  force  vector  f  can  be  desenbed  as  the  sum  of  two  generalized 
impulsive  and  non  impulsive  forces 

f=/(i)+/(ni)  (31) 

Since  the  period  of  contact  is  assumed  to  be  very  short,  i.e.,  almost  zero,  only  the 
impulsive  forces  have  nonzero  impulse;  all  other  forces  are  Enite  including  the 
gyroscopic  and  (Zoriollis  forces.  In  fact  it  can  be  shown  that  integrating  by  pam  the  last 
temiofEq.  30 
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therefore  Eq.  30  becomes 


(33) 


5.1.  THE  SLIDING  PROBLEM  FOR  OPEN  LOOP  SYSTEMS 

Assuming  that,  during  contact,  the  process  of  tangential  force  generaoon  is  that  of  dry 
fncQon,  the  impulsive  force  can  be  wntien  as 

f<'>  =  f!,(n  +  nt)  (34) 


where  ^  represents  a  fhction  coefficient  The  generalized  impulse  vector  yields  for  this 
case 

R  =  it„<c„+^c,)  (35) 

SubsDtutuig  Eqs.  35, 33  and  29  inio  Eq.  23 

RM'';t„(c„  +HC,)  =  dv,  -n(I+«)cj6*’>  (36) 

Premultiply  both  sides  by  and  reaUiing  thai.  by  definition:  ivt  is  perpendicular  to  n; 
nTn»l  and  from  Eq.  18,  the  scalar  value  of  vn  is  guiven  by  3cj6'’\then 


n’'RM‘'it„<c„  +HC,)  =  -(l+e)v<;> 

This  scalar  equanon  can  be  solved  for  the  normal  impulse 

(l-*-c)vii'> 

""  cIm’'(c„  +  hc,) 


(37) 


(38) 


5.2.  THE  STICKING  PROBLEM  FOR  OPEN  LOOP  SYSTEMS 

To  solve  the  sticking  problem  the  impulse  must  be  described  by  Eq.  28  and  an  extra 
kinematic  condition  has  to  considered  as,  in  a  socking  inspact  the  outgoing  relative 
tangcnnal  velocity  vanishes,  thus  =  0  and  The  slip  veloaty  for  can 

be  expressed  in  the  more  convenient  form 


vj’^  =  -  nvj,'^ 


=  (R-n.cJ)9W 


(39) 
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which  allow  us  to  wnte  Eq.  23  in  the  form 

RAe  =  -(R+en.cJ)0''>  (40) 

In  order  to  wnte  an  impulse  equaaon ,  subsniute  Eqs.  28. 33  and  29  m  Eq.  40  to  get 

RM''(c„n„  +c,it,)  =  -(R  +  en.cJ)e<‘'  (41) 

Finally,  premultiplying  the  preceding  equation  by  n^  and  by  tT  a  set  of  two 
momemtum  balance  impulse  equations  can  be  wnnen  in  mamx  form  as 

■cJm-'c„  cJ'M-'c,|>t„]  |-(l+e)v(-> 

Equaaon  42  is  a  set  of  two  linear  equations  in  teims  of  the  normal  and  tangennal 
components  of  impulse. 

i.  Closed  Loop  Systems 

The  change  ui  the  generalized  joint  velocioes  during  impact  must  satisfy  the  constraints 
ofEq.  7 

Cil9  =  C  (43) 

FromEq.  l3  we  have 

<i9  =  M-'(dp+C'‘'A<J)  (44) 

Then, 

CM’'(dp+C'^A<j).0  (45) 

Intcgraung  the  canonical  cquauons  of  motion  described  by  Eq.  14  for  the  penod  of 
contact  yields 

iip  =  j  f  dt + M0  dt  -  C^o  dl  (46) 

All  the  forces  in  the  nght  hand  side  of  Eq.  34  arc  bounded  except  for  impulsive 
forces.  The  integral  of  this  bounded  forces,  including  the  term  containing  o  arc  aero. 
This  can  be  shown  easily  by  wnnng 

-(C^o)  =  c'^o+c'^d  («) 

dt 
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ihen, 

i;‘;’c^od.=c^o 

=  C^^a-C^Aa  =  Q 

which  allow  us  to  conclude  that  the  change  m  the  total  momenta  for  closed  loop  systems 
IS  soil  a  res^  It  of  the  impulsive  forces  as  described  by  Eq.  33. 

6.\  THE  SLIDING  PROBLEM  FOR  CLOSED  LOOP  SYSTEMS 

Using  the  same  procedjre  as  in  secaon  5.1  and  taking  m  consideration  Eq  44  instead 
of  Eq.  29  an  equivalent  of  Eq.  37  is  then  obtained  for  closed  loop  systems 

cJm-'[(c„  +  nc,  )r.  +  C^Aol  =  -(I + e)cJe<->  (50) 

Equations  46,  after  subsDiunng  Ap  firom  Eq.  33  have  the  form 

CM''(c„+(ic,)it  +  CM''c'^Ao  =  0  (50 

which  can  be  appended  to  Eq.  50  and  then  wntien  in  the  manix  form  as 

CM'C'  CM‘(c.+pc.)lfAo)  I  0  1 

cjM  'C'  cjM  '(c,  +pc,)Jl  It  j  " l-<l+e)v, J 

which  can  be  solved  for  the  internal  impulses  Ao  and  the  normal  component  of  unpulse 
It  acting  at  the  pouit  of  contact. 

6  2.  THE  STICKING  PROBLEM  FOR  CLOSED  LOOP  SYSTEMS 

Using  die  same  procedure  as  in  section  5.2  and  taking  in  consideianon  Eq.  45  mstead  of 
Eq.  29  an  equivalent  of  Eq.  42  is  then  obtained  for  closed  loop  systems 

'CM'C^  CM'c.  CM‘c,]fAtj|  0 

cjM'C'  cjM'c,  cjM'c,  It.  =  -(l+e)v.  (53) 

c'M‘'C''  c^M  'c,  c'M'c,  It,  -V, 


(+) 

-C‘f,,  odt 
i(-) 


winch  can  be  solved  for  the  internal  impulses  Ao  and  the  normal  and  tangenaal 
components  of  impulse  it  aenng  at  die  point  of  contact 
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7.  Contact  Law 


When  contact  is  m  effect  a  contact  law  is  now  suggested  for  the  tradiuonal  isotropic 
Coulomb  law  of  fhcnon  involving  the  following- 

-  viM  IS  aero  if  the  magnitude  of  the  tangenual  impulse  is  less  then  the  p  umes  the 
magmtude  of  the  normal  impulse. 

■when  has  a  nonzero  tangenual  component.  ViH*  0  the  tangenual  unpulse  has  a 
magmnide  4  times  the  magmtude  of  the  normal  impulse. 

For  pianar  oblique  unpacts  this  contact  law  involves  the  foUowmg- 

If  y^^*)  =  0  then  It,  £  pit„  (54) 

If  Vt(-r)  *  0  then  it,  -  pitn  (55) 

and  taking,  for  the  moment 


which  means  that  the  tangenual  impulse  acts  along  the  opposite  dixecoon  of  v,(').  This  is 
a  plausible  assumption  which  wtU  be  shown  to  correspond  to  a  maximum  energy  loss  m 
planar  unpacts.  However  in  spaual  oblique  unpacts  the  tangenual  velocity  generally 
undergoes  a  change  in  direcuon  which  enables  a  direct  dcteimmanon  of  the  direcnnn  of 
the  tangential  impulse.  Formulauons  using  standard  Convex  Analysis  (14-15]  have 
shown  that  the  Coulomb's  law  of  fhcnon  is  exactly  similar  to  a  law  of  perfect  plasticity 
and  can  be  derived  from  a  “principle"  of  maxunal  dissipanon.  As  a  result  the  duecnon  of 
the  tangential  impulse,  t,  should  be  such  that  the  energy  loss  during  impact  is 
maximized. 


8.  Velocity  Jumps  and  Rebounds 


Procedures  for  updaung  velocioes  after  the  impact  are  now  obtained,  'e/ithout  loss  of 
generaUty  consider  the  sliding  problem  for  open  loop  systems  described  m  secnon  5.1 
Taking  in  considerauon  Eq.  33  and  subsumting  Eq.  38  in  Eq.  29  the  jump  m  the 
generalized  velociues  can  be  obtained 


Ae  =  -M'‘(c„vpc,) 


4jM''('n+F't) 


And  from  Eqs.  23  and  2 1  the  jump  in  ihe  tangenual  velocity  can  be  obtained 
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A  procedure  for  updating  velocities  m  a  general  oblique  impact  can  be  stated  for 
closed  (open )  loop  systems  as. 

ALGORITHM. 

Knowing  the  posmons  and  velocmes  at  d  > 

1.  Find  :Cn  and  rtt  ^3  (42) 

if  Kx  ^  ^7Cn  go  to  2 

if  ni  >  4^0  go  to  3 

2.  We  have  sncnon  with  *  0 

2. 1  From  £q.  28  evaluate  »  CnTCn'Ktnt 

2.2  Go  to  4 

3.  We  have  sliding 

Find  Ttn  from  Eq.  52  (38) 

4  Evaluate  A0  from  44  (29) 

5.  Update  joint  velocmes  as  0  (♦)  •  0  (•)  ♦  A0 
6  Resume  with  integraaon 


9.  Examples  and  Numerical  Results 


The  purpose  of  this  sccuon  is  to  apply  the  present  piecewise  analysis  to  typical  examples 
of  mcchamcal  systems  and  to  show  the  validity  of  the  rorihod  by  examining  the  impact 
responses. 

9.1.  SLIDER-CRANK  MECHANISM 

This  first  example  is  taken  from  reference  (7|  where  it  was  solved  using  a  piecewise 
formuiation  widi  equations  of  motion  desenbed  in  terms  of  a  large  set  of  absolute 
cancsian  coordinates.  This  is  a  closed  loop  mulnbody  system  impacong  a  sliding  body. 
A  schemanc  representaaon  of  the  system  is  shown  in  figure  2.  A  set  of  rclanve  joint 
coordinates  0i,  02. 03  and  04  arc  used  to  describe  the  configuranon  of  the  system.  Due  to 
^  the  closed  loop,  0i,  ©2  and  ©3  must  satisfy  Eq.  6,  and  their  first  time  derivatives  must 

sausfy  Eq.  43.  ,1 

t  The  slider  crank  is  dnven  by  a  restoring  torque  siwh  that  the  crank  maintams  almost 

^  a  constant  angular  velocity.  At  some  instant,  the  slider  (body  3)  impacts  the  free  slider 

I  (body  4)  which  is  dnven  inertially  to  the  left  ai  a  constant  speed.  A  coefficient  of 

i'  resntuuon  e  »  0.83  between  the  blocks  is  considered. 

f  This  case  correspond  to  a  central  impact  problem  therefore  no  tangential 

velocmes  are  observed  and  no  tangential  impulsive  forces  arc  developed  between  bodies 
t  3  and  4  dunng  the  impact. 

f 

I 

I 
I 
f 

u 
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i|a  lS3m  ml  a  m3  ■  038  kg 
12*  J06  m  m2*  076  kg 


Figure  2.  Impact  between  a  slider-crank  mechanism  and  another  slider 


The  results  from  this  analysis  and  those  of  reference  {7]  can  be  ^ummanzed  m  table  1. 


Present  results 
m/s 

41.58 

6^ 

•6SJ85 

The  implied  loss  of  kinetic  energy  induced  by  the  impact  is  given  by 

Ti.  = 

2  2 

resulting,  for  central  impacts  in  the  form 

For  ihe  general  oblique  impacts  the  induced  energy  loss  can  be  shown  to  be 
Tl  =  -7'<5(n>nn  +2Fmnt  +H^ina)  -)t„(vW  +  nv<->) 


,  =  cJm''c„  ;  m„,  =  cJm''c,  :  m„  =  c^M-'c, 
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Figure  3  shows  a  plot  of  a  non  dimensionalized  form  of  the  energy  loss  of  the  system 
( AT/T(') )  for  the  range  of  the  coefficient  of  fncaon  0  ^  c  i  1 ,  and  for  three  different 
masses  of  the  inemaJiy  driven  slider  (cose  I:  nu  »  0.19;  case  2:  nu  s  0.95  and  case  3. 
nu  » i  9). 

For  case  1 .  with  esO.  the  energy  loss  is  almost  equal  to  the  minal  hneuc  energy  of  the 
system  before  impact,  which  means  that  the  system  came  to  a  halt.  For  case  2  and  3. 
where  the  mass  of  body  4  was  increased,  only  54%  and  32%.  respecovely,  of  the  miaal 
kinenc  energies  are  dissipated  during  perfectly  plastic  collisions  <e  »  0)  Case  1  is  a 
particular  case  where  the  generalized  mass  of  the  crank  and  sbder  is  equivalent  to  the 
inertialy  dnven  mass.  Case  1  can  be  reasoned  to  be  “equivalent"  to  the  f^rfectly  plasuc 
central  impact  of  two  particles  that  is  known  to  come  u>  a  halt  when  these  masses  are 
equal,  thus  releasing  all  kuieoc  energies. 


Figure  3.  Energy  loss  versus  the  coefficient  of  restmiQon 


9.2.  KANE'S  DOUBLE  PENDULUM -PLANAR  CASES 

9  2  1.  Care  1.  Fig.  4a)  shows  two  slender  rods  connected  together  and  to  a  fixed  suppon 
vi>i'  revolute  jomts,  the  system  is  only  allowed  to  move  m  the  XY  plane. 

Tile  rods  are  identical  and  the  approaching  joint  velocides  are  dis-1  and  -i 
(lad/s).  This  configuration  implies  an  wcotning  velocity  v^’) » (-2.6831  •  l.309n). 

Figure  5  shows  the  tangential  velocity,  for  0  ^  e  iS  Land  -.45  ^  ^  .45. 
Posmve  values  of  \i  correspond  to  tangenoal  impulses  in  the  t  direction  whereas  negaave 
values  of  correspond  to  tangential  impulses  along  the  posmve  X  direction.  A  plot  of 
the  energy  loss  as  defined  in  61  is  also  shown  in  figure  7. 

It  car.  be  observed  that  negaave  values  of  correspond  to  smaller  energy  losses  or  even 
energy  gams.  On  the  other  hand,  sucking  is  not  always  possible.  For  example,  for 
vaijcs  of  c<.J,  even  for  large  values  of  there  is  always  a  posmve  v^W  For  larger 
vali  es  of  c,  sucking  can  only  occur,  eventually  with  energy  gams  which  is  not  plausible. 


M9 


Cocfflcitat  of  frktIoB 

Figure  6.  Energy  loss  for  the  Kane's  pendulum  a) 


9.2  2.  Case  2.  The  double  pendulum  illustrated  m  figure  4b)  was  also  aniysed.  In  this 
pendulum  the  first  rod  is  in  the  veracal  posidon.  For  this  configuration  and  assuming 
the  same  angular  velocides  as  in  cases)  the  .relative  mcoming  velocity  is  now 
v,(-)  =  (..707n-2.844t). 

Figure  7  shows  the  predicted  outgoing  tangential  velocities  for  OS  e  SI.  and 
-  4  5  S  p  S .  4  S .  The  results  show  that  this  pendulum  never  socks,  even  for  large  values 
of  p  ihe  tangennal  outgoing  velocity  is  always  posiove. 


Fifute  7.  Tangennal  rebound  prcdicnons  for  the  Kane’s  pendulum  b) 


These  results  clearly  show  that  the  impact  conditions  are  strongly  dependent  on  the 
mechanical  system  and  its  configaranon  at  the  time  of  impact.  A  method  is  now 
proposed  to  verify  analyocally  whether  or  not  snenon  can  occur. 

Without  loss  of  generality  consider  the  open  loop  case  under  sucking  conditions.  As 
the  normal  n  was  defined  from  body  j  to  body  i  and  ihe  tangenual  vector  t  was 
considered  along  dV(,  or,  m  the  opposite  sense  of  v,(-).  thus  the  solunon  of  Eq.  42  should 
always  yield  posiuve  normal  and  tangenual  impulses. 

Acconlmg  to  Crammer's  role 


where 

D  = 


-Si 

-Si 

'  "'d’ 

’  '  ~  D 

klM-'c. 

clM'cJ 

|c'M''c, 

c'M  'cj  ’ 

|-<l+e)v” 

-v!' 


cjM'‘c,  cJm'c, 
c,^M  ‘c,  ’  ^  c,^M''c, 


(63) 


-(Ue)  vi>| 


Therefore  if  D  >  0,  then  D  j  >  0  and  D2  >  0  or  if  D  <  0,  then  D  i  <  0  and  D2  <  0.  In  the 
present  cases  D>0  then  the  necessary  condiaons  for  sQcoon  to  occurs  can  be  wnten  as 


cfM'‘c,vi  *  -<1  +  e)  c,^M  'c,v”  >  0  (64a) 

<l  +  e)cf  M'c,  v'  ’  -  cIM'c,  v[  *  >  0  (64b) 


which  can  be  used  to  define  bounds  on  e  for  suction  to  be  possible. 

9.3.  3D  DOUBLE  PENDULUM 

Cc  'Sider  now  that  the  double  pendulum  is  also  rotating  around  the  Y  axis  with  an 

angular  velocity  83  as  shown  m  figure  8.  As  it  is  shown  the  vectors  ti  (opposite  to  the  X 
axis)  and  t2  (along  the  Z  axis)  define  the  contact  plane.  At  the  tuse  of  impact  the  joint 

velocities  are  9i  s  >1  and  ^  » -I  and  63  »  1  (rad/$),  resulting  m  the  approach  velocity 
vr(-)s. 2.683  ti^..809  t2.L309n. 

The  algorithm  desenbed  in  section  8  was  used  and  it  can  be  shown  that  sliding 
condiQons  prevail  for  this  case,  therefore  38  must  be  used  to  obtain  the  nons^ 
component  of  the  inpulse.  However,  acording  to  the  proposed  contact  law,  the  direcaon  I 
of  the  tangenual  impulse  must  be  such  that  the  energy  dissipation  during  the  impact  is 
maximized.  Eq.  61  clearly  shows  the  depen^ncy  of  Ti  on  t.  A  plot  of  the  vanauon  of 
Tl  for  the  present  3D  pendulum  example,  when  t  is  considered  to  rotate  an  angle  a 
anticlockwise  from  the  direction  of  V|(')  is  shown  in  figure  9.  The  direcaon  of  t 
corresponding  to  a  maximum  energy  dissipauon  1$  denoted  by  the  angle  Ofn.lt  should  be 
observed  that  for  this  direcoon  a  value  of  rtn  »  4.02  N.sec  is  predicted  which  is  78%  of 
the  maximum  normal  imput  (for  a  -  196.25).  ao  and  ai  are  two  other  important  angle 
values.  They  define  a  sector  corresponding  to  directions  of  the  tangenual  impulse  that 
imply  energy  gams,  therefore  arc  not  accctable. 
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ml=ra2=l. 

Jl=J2=ni]/12 

b=l. 

81=18  deg  81=-1 
82=12  deg  d2=-l 
83=0.  deg  83=1 


LQI 


TOP  VIEW 


Figure  9. 3D  Double  pendulum 

Figure  10  illusvates  che  vectors:  the  tangential  velocity  jump,  AV(,  the  outgoing 

langenoal  velocity.  vx^*\  and  the  tangenaal  impulse,  itt,  corresponding  to  maximum 
energy  dissipation.  Another  vector  t  for  the  dir^on  of  the  tangenaal  impulse  is  also 
represented  which  was  obtained  from  Ref.  (16]  where  an  averaging  process  of  the 
tangential  components  of  the  approach  and  separation  velocities  have  been  used.  It 
clearly  shows  that  the  tangenoal  impulse,  in  general  is  not  colhnear  with  V|(*)  and 
The  present  calculations  predict  at  the  point  of  contact: 

=. 675  ti  +  .  4112 +  .916n;‘ 

Ap  =  1.26  ti-  99t2+4.026n 

A  modificaaon  on  the  algonthm  in  section  8  must  then  be  mooduced  in  step  3 
where  nn  must  be  found  from  Eq.  52  (38)  for  closed  (open)  loop  systems,  using  a 
direcaon  t  that  minimizes  Tt.This  process  is  highly  non  linear  and  can  be  earned  out 
with  the  use  of  any  standard  minimizaaon  algonthm. 
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10.  Conclusions 

in  this  paper,  a  method  was  presented  for  the  piecewise  analysis  of  the  mtennittent 
monon  of  mechamcal  systems.  A  canonical  form  of  the  unpulse  of  momentum  equations 
for  mulabody  systems  can  \x  esublished  m  terms  of  a  immmum  set  of  joint  coordinates 
and  can  be  solved  casiy  for  the  jump  in  the  joint  velocities  during  the  impact.  This 
solution  also  finds  the  impulsive  forces  exened  on  the  contact  surfaces  of  the  colUdmg 
bodies  and  provide  a  means  by  which  necessary  condiuons  are  mtroduced  for  sncnon  or 
sliding  to  occur.  The  analytical  set  is  complet^  by  a  system  of  contact  laws  mvolving 
the  introduction  of  a  coefficient  of  resntumon  tradidonally  used  for  the  descnpnon  of 
two  body  collisions  and  a  coefficient  of  fhcQon  associated  with  the  Coulomb's  dry 
fncQon  model  and  assummg  that  Action  is  developed  m  a  such  a  way  that  a  maximum 
dissipation  of  energy  will  observed.  Since  the  impuise*momenium  represent  a  first 
inicgrai  of  the  motion,  velocity  jumps  can  be  calculated  in  a  straight  forward  manner 
allowing  an  immediate  assessment  of  energy  changes. 
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IMPACT  DYNAMICS  OF  MULTIBODY  MECHANICAL  SYSTEMS  AND 
APPLICATION  TO  CRASH  RESPONSES  OF  AIRCRAFT  OCCUPANT/ 
STRUCTURE 


D.  MA,  R.  MENON  and  H.  M.  LANKARANI 
Mechanical  Engineenng  Depanment 
and  Nanonal  Insatute  for  Aviaoon  Reaeaich 
Wichiu  Slate  University 
Wichita,  KS  672«W)035,  USA 

ABSTRACT.  Analydcal  evaluaoon  of  the  performance  of  multibody  mechanical  systems 
becomes  rapidly  unmanageable  as  the  complexity  of  the  systems  mcrease.  For  problems 
that  involve  inierrmtieni  monon  due  to  an  impact,  prediction  of  the  responses  is  even 
more  difficult.  In  an  impact,  nonlinear  contact  forces  of  unlcnown  nature  are  created, 
which  act  and  disappear  over  a  short  penod  of  hme.  In  this  paper,  different  contact 
force  models  are  formulated,  with  which  a  continuous  analysis  method  is  developed  for 
a  simple  two-panicle  impact.  The  procedure  is  then  generalized  to  impact  in  muinbody 
systems  using  the  concept  of  effective  mass.  A  piecewise  analysis  method  is  discussed, 
which  IS  based  on  a  canonical  form  of  the  system  impulse/momentum  equations.  The 
suitability  of  these  methods  are  discussed  by  application  of  these  procedures  to  some 
examples.  An  opamizahon  methodology  is  then  discussed  for  the  selecuon  of  proper 
parameters  in  a  given  contact  force  model.  The  use  of  this  techmque  in  the  selecuon  of 
the  most  suitable  maienals,  which  are  impact-resistant,  is  also  discussed. 

The  methods  discus^  earlier  are  applied  to  the  seat-occupant-restnunt  sysiem  of 
an  aircraft.  A  descripuon  of  a  computer-aided  analysis  environment,  includmg  a 
muldbody  model  of  the  occupant  and  a  nonlinear  finite  element  model  of  the  seat,  is 
provided,  which  can  be  used  to  re-construct  variety  of  crash  scenarios.  These  detailed 
models  are  useful  in  studies  of  the  potenual  human  injunes  in  a  crash  environment, 
injunes  to  the  head,  the  upper  spinal  column,  and  the  lumbar  area,  and  also  structural 
behavior  of  the  seat.  The  problem  of  reducing  head  mjunes  to  an  occupant  in  case  of 
a  head  contact  with  the  surroundings  (bulkhead,  mtenor  walls,  or  mstrument  panels),  is 
then  considered.  The  head  impact  scenario  is  re-constructed  using  a  nonlinear  visco- 
elasuc  type  contact  foroe  model.  A  measure  of  the  opnmal  values  for  the  bulkhead 
compliance  and  displacement  requirements  is  obtained  in  order  to  keep  the  possibility  of 
a  head  injury  as  bttle  as  possible.  This  information  could  in  turn  be  used  m  the  selecuon 
of  suitable  materials  for  the  bulkhead,  instrument  panels,  or  intenor  walls  of  an  aircraft. 
The  developed  analysis  tool  also  allows  aircraft  designers/engmeers  to  simulate  a  vanety 
of  crash  events  m  order  to  obtam  mformauon  on  mechamsms  of  crash  protecuon,  designs 
of  seats  and  safety  features,  and  biodynamic  responses  of  the  occupants  as  related  to 
possible  injunes. 


1.  Introduction 

A  colhsion  between  the  two  bodies  is  known  as  an  impact  during  which  forces  are 
created  that  act  and  disappear  over  a  shon  penod  of  ume.  The  durauon  of  the  contact 
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p«nod  governs  the  choice  of  the  method  used  to  analyze  the  impact.  The  methods  for 
predicung  the  impact  responses  can  pnmanly  be  classified  into  two  groups.  In  one.  the 
impact  IS  treated  as  a  discontinuous  event.  Momennim-balance/impulse  equations  are 
usually  formulated  by  integrating  the  accelerauon-based  form  or  the  canonical  form  of 
the  goverrung  equations  of  monon.  The  soluuon  to  these  equations  gives  the  jump  in  the 
velocioes  or  momenta,  with  which  the  mtegraiton  of  the  equabons  of  mouon  can  be  re- 
started.  This  classii^  approach  has  been  followed  by  many,  for  direct-central  and 
oblique  impacts  of  two  free  solids  not  connected  to  other  bodies  [1-3].  For  an  impact 
within  a  mulubody  system,  a  set  of  momentum  balance-impulse  equauons  was  developnl 
by  Wehage  [4].  Khulief  and  Shabana  extended  these  equabons  to  flexible  muibbody 
systems  [Sj.  In  (6],  it  was  shown  that  in  order  to  gam  numencal  efficiency  and  stability, 
the  equabons  of  monon  for  a  muibbody  system  may  be  assembled  in  a  canonical  form. 
In  this  formulaoon,  a  reduced  set  of  momentum  balance-impulse  equabons  was  developed 
based  on  die  nme  mtegiabon  of  a  canonical  form  of  the  ^uabons  of  monon.  In  order 
to  perform  this  so-called  'piecewise  analysis,*  the  coefficient  of  resumnon  between  the 
two  colliding  bodies  must  be  known.  Although  this  method  is  relanvely  efficient,  the 
unknown  duranon  of  conuct  limits  its  applicability.  If  the  duranon  of  contact  is  large 
enough  that  significant  changes  occur  in  the  conflguiabon  of  the  muibbody  system,  then 
the  assumpbon  of  instantanetty  of  impact  is  no  longer  valid. 

In  the  second  group  of  methods  used  for  impact  analysis  of  mulubody  systems,  the 
local  deformanons  and  the  contact  forces  are  treated  as  connnuous.  The  impact  analysis 
of  the  system  is  hence  performed  simply  by  including  the  contact  forces  in  the  system 
equauons  of  monon  during  the  contact  period.  The  application  of  this  so-called 
’connnuous  analysis,*  requires  knowledge  of  the  variation  of  contact  force  during  the 
contact  period.  Different  models  have  been  posnilated  to  represent  this  vananon.  In  the 
most  simple  one,  the  conuct  force  is  modeled  by  a  paiallel  linear  spnng-damper  element 
[7],  This  model,  known  as  the  Kelvin-Voigt  viscoelasnc  model,  has  been  used  for  the 
impact  between  two  bodies  within  a  multibody  system  [8].  However,  this  linear  model 
may  not  be  very  accurate  since  it  docs  not  r^resent  the  ove^l  nonlinear  namre  of  an 
imract.  Furthermore,  the  half-sine  shape  soluuon  that  it  provides  for  the  local 
deformabon  of  the  two  bodies  in  the  dtrecnon  of  impact  suggests  that  the  two  bodies 
exert  tension  on  each  other  right  before  the  reboundmg  s’age.  A  more  suiuble  model 
of  the  conuct  force  is  the  nonlinear  Hertzian  force-displacement  law  [9).  Although 
Hertzian  theory  is  based  on  elasncity,  some  studies  have  been  performed  to  extend  the 
theory  to  mclcde  energy  disstpanon  [7,  10-12). 

In  this  paper,  connnuous  contact  force  models  are  presented,  for  which  unknown 
parameters  are  analyncally  evaluated.  In  one  mode-,  mtemal  damping  of  the  impaenng 
bodies  IS  used  to  represent  the  energy  dissipabon  at  low  impact  velocmes.  A  hysteresis 
dampuig  function  or  this  nature  assumes  that  the  loss  of  energy  in  impact  is  all  due  to  the 
matenal  damping  of  the  colliding  solids,  which  dissipates  energy  in  the  form  of  heat. 
At  fairly  moderate  or  higher  velociues  of  colliding  solids,  espKially  metalhc  solids, 
permanent  mdenuuons  ate  left  behind  on  the  coUidmg  surfaces.  In  the  second  contact 
force  model,  which  covers  these  cases,  local  plasticity  of  the  surfaces  in  contact  becomes 
the  dominant  source  of  energy  dissipabon  in  impact.  For  both  models,  the  unknown 
parameters  are  evaluated  by  energy  and  momentum  consideiauons  in  terms  of  the 
velocmes  of  the  sohds  before  impact  and  the  coefficient  of  resutuuon.  The  two-parucle 
modei  IS  then  generalized  to  impact  analysis  between  two  bodies  of  a  mulubody 
mechanical  system.  The  concept  of  effeenve  masses  is  uiiroduced  to  take  mio  account 
the  effect  of  jomt  forces  or  impulses.  The  suitability  of  the  different  methods  is 
discussed  by  applicanons  of  the  procedures  to  some  examples,  including  a  vehicle 
rollover.  An  opbimzabon  methodology  is  then  discussed  for  ihe  seiecuon  of  proper 
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parameters  in  a  given  contact  rorcc  model.  The  objective  would  be  to  minimize  the 
maximum  acceleration  of  the  system  effecuve  mass(es),  such  that  the  maximum 
deformaaons  fall  below  a  certain  range.  The  design  parameters  would  be.  for  example, 
the  linear  or  nonlinear  stiffhess  coefficients,  damping  coefficients,  amount  of  permanent 
indentation,  etc.  The  use  of  this  technique  in  the  selecuon  of  the  most  suitable  materials, 
which  are  impact-reststant,  are  discussed. 

The  methods  discussed  earher  are  appbed  to  the  seat-occupant-restraint  system  of 
an  aircraft.  To  improve  passenger  safety',  the  design  and  the  arrangement  of  the  seats, 
types  and  charactenstics  of  the  restraints,  and  the  dynamic  performance  of  the  occupants 
in  vanous  crash  environments  must  be  known.  A  dcscnpuon  of  a  computer-aided 
analysis  environment  is  provided,  which  can  be  used  to  re-consmict  variety  of  crash 
scenanos.  The  analysis  capability  rehcs  on  the  development  of  a  mulubody  dvnamic 
model  for  the  occupant.  The  occupant  model  is  based  on  the  model  from  the  code'  SOM- 
LA/TA  (Seat  Occupant  i(odel-Ught  Aircrafl/Transport  Aircraft)  [13-14).  Body 
segments  are  connected  by  joints  which  impose  resistance  in  terms  of  a  nonlinear 
displacement  limiting  moment,  viscous  damping,  and  muscle  tone.  The  model  of  the 
up^r  spinal  column  has  been  refined  to  include  the  seven  vertebrae  and  a  hydrodynamic 
model  of  the  skuU/brain.  A  quast-stauc  analysis  capability  of  the  ngid  mulubody 
dynamics  of  the  gross  motion  of  the  occupant,  together  with  a  finite  element  model  of 
the  lumbar  spine,  have  also  been  developed.  These  detailed  descnpuons  make  the  model 
useful  in  studies  of  the  potential  human  injuries  in  a  crash  environment,  injuries  to  the 
head,  the  upper  spinal  column,  and  the  lumbar  area.  A  nonlinear  finite-element  model 
of  the  seat  structure  is  also  used  which  mcludes  large  plasQc  deformanons.  buckling  of 
bending  members,  material  nonUneanty,  etc. 

One  aspect  of  these  studies  is  to  reduce  head  mjunes  to  an  occupant  in  case  of  a 
head  contact  with  the  surroundings  (bulkhead,  intenor  walls,  or  instrument  panels).  In 
this  paper,  the  head  impact  scenano  was  re-constructed  using  a  nonlinear  visco-elasnc 
type  contact  force  model  of  exponential  form.  The  snffness  coefficients  in  the  model 
were  obtained  from  experimental  correlations,  and  the  damping  coefficient  was  obtained 
using  Rayleigh  formulation.  Correlated  studies  of  the  analyti^  simulation  with  impact 
sled  test  results,  performed  at  National  Institute  for  Aviauon  Research  (NIAR)  and  Civil 
AeroMedical  Insutute  (CAMl),  were  accomplished.  A  parametnc  study  of  the 
coefficients  in  the  contact  force  model  was  then  performed  in  order  to  obtain  the 
correlation  between  the  coefficient  and  the  Head  Injury  Cntena.  A  measure  of  the 
optimal  values  for  the  bulkhead  compliance  and  displacement  requirements  was  thus 
obtained  in  order  to  keep  the  possibility  of  a  head  injury  as  little  as  possible. 


2.  Contact  Force  Models 

When  two  solid',  are  in  contact,  deformauon  takes  place  in  the  local  contact  zone 
resultmg  in  a  contact  force.  This  suggests  that  the  contact  force  is  directly  related  to  the 
amount  of  local  deformation  or  indentauon  of  the  two  solids.  The  best-known  force 
model  for  the  contact  between  two  spheres  of  isotropic  matenal  was  developed  by  Hertz 
based  on  the  theory  of  elasticity  (9).  With  ladu  R,  and  R,  of  the  two  spheres  "i"  and  "j", 
and  masses  m,  and  m,,  the  contact  force  f  follows  the  relation 

f  •  K  5*  , 

where  S  is  amount  of  the  relauve  penetrauon  or  indentauon  between  the  surfaces  of  the 
two  spheres  and  n  =  1.5.  The  generalized  parameter  K  depends  on  the  material 
properties  and  the  radu  of  the  spheres; 


where  the  matenal  parameters  h,  and  h,  are 
^  1  - 
"'■-rET' 


Variables  u,  and  E,  are,  respecuvely,  the  Poisson’s  rauo  and  the  Young's  modulus 
associated  with  each  sphere. 

Consider  now  a  situation  for  which  the  contact  between  the  two  spheres  is  caused 
by  a  collision.  Tbe  two  spheres  have  velocmes  V,<’  and  V,<>  nght  before  impact.  It  is 
intended  to  determine  the  vanauons  of  the  intetacnon  foije  between  the  two  spheres 
during  the  shon  penod  of  contact.  The  normal  direction  n  to  the  contact  surfaces  and 
a  pair  of  forces  i  and  -f  are  shown  in  Figure  1.  In  general,  the  resulung  contact  may 
be  considered  to  occur  in  two  phases:  the  compression  phase  and  the  resutuuon  phase 
Dunng  the  compresston  phase,  the  two  spheres  deform  in  the  normal  direcuon  to  the 
impact  surface,  and  the  relative  velocity  of  the  two  spheres  is  reduced  to  zero.  The  end 
of  the  compression  phase  is  referred  to  as  the  instant  of  maximum  compression,  or 
maximum  approach.  The  resatuuon  phase  starts  at  this  point  and  lasts  unul  the  two 
spheres  separate. 


Figure  1.  A  direcwent:.'.  impact  if  'wo  spheres. 


Generally,  the  two  spheres  will  not  rebound  with  the  same  imtial  velocities,  because 
part  of  the  iniw  kinenc  energy  is  dissipated  in  the  form  of  permanent  deformauon,  heat, 
etc.  It  IS  apparent  that  the  contact  force  model  of  equauon  (1)  cannot  be  used  dunng 
both  phases  of  contact,  since  this  would  suggest  that  no  energy  is  dissipated  in  the 
process  of  impact.  One  popular  treatment  is  based  on  the  idea  that  dissipauon  of  eneray 
occurs  m  the  form  of  internal  damping  of  coUidmg  solids.  This  assumpuon  is  valid  fbr 
low  impact  velocities;  i.e..  those  impact  situations  for  which  impact  velocmes  are 
negligible  compared  to  the  propaganon  speed  of  deformation  waves  across  the  soUds. 
The  contact  force  model  will  then  be  in  terms  of  a  damping  coefficient  D, 

f  -  K  *  D  i  , 

where  { is  the  relative  (or  indentanon)  velocity  of  the  solids.  A  hysteresis  form  for  the 
damping  coefficient  was  proposed  by  Hunt  and  Grossley  (10)  as 

D  •  (I  4*  , 

where  the  parameters  p  is  called  the  "hysteresis  damping  factor."  The  contact  force 
model  of  equanon  (4)  may  be  used  for  the  enure  penod  of  contact.  With  this  model,  the 
energy  loss  is  assumed  to  be  due  to  the  matenal  damping  of  the  bodies,  which  would 
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dissioaie  energy  m  the  form  of  heat.  For  known  parametera  K  and  D  (or  (i),  the  shape 
of  the  hysteresis  loop  corresponding  to  this  force  model  and  the  soluaon  coiresponding 
to  the  vanahons  of  the  mdentaaon  with  nme  are  shown  in  Figure  2  [IS].  In  this  figure, 
t' r".  and  t'*’  denote  the  ome  of  minal  contact,  the  ume  of  maximum  indentanon.  and 
the  ume  of  separauon  of  the  local  contact  suraces.  respecnvely.  Variables  5,  and  f, 
refer  to  the  values  of  mdenaaon  and  the  contact  force  at  nme  t'".  In  the  contact  force 
model  of  equanon  (4),  the  dampmg  coeffiaent  D  or  the  hysteresis  dampmg  factor  4  must 
be  determined.  An  esdmate  of  the  parameter  4  ba^  on  the  classical  impulse- 
momentum  equanon  and  the  work-energy  principle  can  be  determined. 


mdentanon  and  (b)  indentanon  versus  ome. 


From  consideration  of  the  Idnedc  energies  before  and  after  impact,  the  energy  loss 
AT  may  be  expressed  in  terms  of  the  coefficient  of  resnmdon  e  and  the  relanve  approach 
velocity  a*’’  ■  V,'-’  -  wp  as 


AT  ■  i*’’"  (1  -  e*) 


(6) 


I 

'  f 


where 


m’'* 


m,  nij 


(7) 


m,  »  m^ 

IS  the  system  equivalent  mass.  The  energy  loss  may  also  be  expressed  by  integtanon  of 
the  contact  force  around  the  hysteresis  loop  as  (16j 


AT  •  dJ  -  ^4  J*  i  da  ai  2  jjv  a*  i  d8  -  |  i  m"  a*’’"  ,  (8) 

where  f  refers  to  the  mtegradon  around  a  hysteresis  loop  for  a  contact  force  of  the  form 
shown  ■in  Figure  2(a).  The  hysteresis  damping  factor  4  may  be  evaluated  by  comparing 
the  nght  sides  of  equadons  (6)  and  (S), 

.  3K(1  -e!)  (9) 

48'-' 

which  shows  a  direct  relanonship  between  the  coefficient  of  resntunon  and  an  equivalent 
dampmg  factor,  the  contact  force  in  conjunction  with  the  damping  represenunon  may 
be  wnner.  m  an  altemanve  fotm  as 


f 


K  ? 


3(1  -  e’) 
4 


which  shows  a  direct  relationship  between  the  coeffic’ent  of 
force. 


(10) 


resutunon  and  the  contact 


'  T 
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TTie  clear  advantage  of  the  Henz  contact  force  n-odel,  f  =  K6‘.  with  its  damping 
representaaon  in  et^uanon  (10)  over  the  Kelvin- Voigt  viscoelastic  model  is  ns 
nonlineanty.  The  overall  pattern  of  impact  is  far  from  linear,  while  the  Kelvin-Voigt 
model  and  its  damping  representation  are  linear  models.  The  solution  for  indentation 
correspondmg  to  the  Imear  models  is  a  half-damped  harmonic.  This  indicates  that  the 
bodies  m  impact  must  exert  tension  on  each  other  nght  before  separation.  On  the  other 
hand,  the  Hertzian  contact  force  model  predicts  no  tension  on  the  bodies  before 
separaaon,  as  observed  from  the  soluaon  for  its  corresponding  indentation  of  Figure 
2(b). 

it  higher  impact  velocines,  the  dissipation  of  energy  is  mostly  in  the  form  of  local 
plasticity,  l^s  means  that  some  permanent  indentahon  is  left  behind  on  the  surfaces  of 
the  two  spheres  after  separaaon.  and  this  mdicanon  accounts  for  the  energy  toss  in 
impact.  This  is  not  an  unreasonable  assumpaon  for  impacLpiobiems  m  which  two 
metallic  bodies  with  imoal  relauve  velocuy  larger  than  10'*  V^p  collide  [17],  ..here  p 
is  the  mass  density  and  the  guannty  i/Efp  >s  the  largM  of  two  propaganon  speeds  of  the 
elasQC  deformaaon  waves  m  the  colliding  solids.  With  this  condiaon,  the  contact  force 
loads  according  to  equaaon  (1)  during  the  compression  period,  and  m  loads  accordmg 
to 


diuing  resniunon. 


where  variable  d,  is  the  permanent  indentation  of  the  two  spheres  after  separaaon.  The 
shape  of  the  hysteresis  loop  corresponding  to  this  contact  force  model  and  the  soluaon 
corresponding  to  the  varianon  of  the  indentation  with  time  are  shown  in  Figure  3. 


»,  •.  •  ,‘>  ' 

(a)  (b) 

Figure  3.  Heru  contact  force  model  with  permanent  indentanon:  (a)  contact  force 
versus  ome  and  (b)  indentanon  versus  nme. 


The  proposed  contact  force  model  can  be  used  for  the  impact  between  two  spheres, 
if  the  parameters  in  the  model  are  loiown.  The  generalized  parameter  K  may  be 
evaluated  from  the  radu  and  the  matenal  propemes  of  the  two  spheres  using  equanon 
(2).  The  remaining  parameters  are  f..  which  can  be  detemuned  by  mtegranng 
the  relauve  indentaaon  equaaons  of  mouon  twice,  subsntuaon  in  the  contact  force 
expression,  and  tntegtaong  the  contact  force  around  the  hysteresis  loop  and  equating  it 
to  the  loneac  energy  loss,  as  [13] 


f„  •  K  5.* 


(12) 

(13) 
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Hence  maximum  indentauon  ot  the  two  spheres  and  maximum  contact  force  depend  on 
the  material  properties,  masses,  radii,  and  velociues  of  the  two  spheres  right  before 
impact.  The  permanent  mdeniaaon  is  evaluated  from  the  miual  approach  velociues  ot 
the  spheres  and  a  ioiown  coefUcieni  of  tesntuoon  between  the  spheres. 

A  conunuous  analysis  may  now  be  performed  by  numencaliy  integtating  the 
equations  of  mooon  of  the  two  spheres  forward  ui  ume  m  conjuncuon  with  the  de"oloi>ed 
contact  force  model.  A  soluuon  is  thus  obtamed  in  the  form  of  posiuons,  velociues.  and 
accelerauons  of  the  spheres  at  any  instant  of  time  during  the  contact  period.  As  a  by¬ 
product  of  the  preceding  parameter  idennficanan  process,  one  can  approximate  the 
durauon  of  the  contact  pettod  between  the  two  spheres  as  (18] 

At  s  2.94  Ji.  .  (15) 


To  lUustiate  the  parameter  esumaoon  process,  a  numerical  example  is  considered 
here.  For  a  direct-cenoal  impact  of  two  identical  aluminum  spheres,  a  coefficieni  of 
resutuuon  of  0.7  and  a  dutauon  of  contact  of  135  iis  were  recorded  from  expenmeni  [7], 
Both  spheres  had  equal  and  opposite  impact  velociues  of  0.15  m/s,  and  each  had  a  radius 
of  0.02  m. 

Based  on  the  presented  theory,  it  is  mtended  to  consmict  the  contact  force  model 


Unuong  value  of  0.02u  m/s  for  the  impact  to  be  considered  elasuc.  Hence,  the  Hertz 
contact  force  model  with  permanent  indentauon  is  a  valid  one.  The  generalized 
parameter  K  is  calculated  mm  eouatian  (2),  with  v  ••  0.33,  u>  be  equal  to  5.50(10’ ) 
N/m'-’.  The  equivalent  mass  of  the  two  spheres  is  obtained  from  equauon  (7)  as  m"* 
<•  0.046  kg.  From  equations  (12),  (13),  and  (14),  the  unknown  parameters  m  the 
contact  force  model  are  evaluated  as 

S.  =  1.35(10-’ )  m;  f,  -  336  N;  «,  =  7.92(10* )  m. 

With  all  the  parameters  detertmned,  the  coniaa  force  model  of  the  two  spheres  is 
constructed  as  shown  ui  Figure  4. 


Figure  4.  A  Hertzian  contact  force  model  with  permanent  indentauon  for  the  impact  of 
two  idenucal  aluminum  spheres  with  impact  ■"■locities  of  0.15  m/s  each. 

Mote  that  the  permanent  indentauon  is  slightly  larger  than  half  of  the  maximum 
relauve  indentauon  for  this  impact  situauon.  which  is  a  significant  amount.  This 
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suggests  that  the  local  plasacity  of  the  contact  sunaces  dunng  impact  cannot  be 
neglecieo.  and  it  again  jusnties  the  validity  of  'he  Hertzian  contact  force  model  with 
permanent  mdentaaon.  A  continuous  analysis  may  be  performed  on  the  two  spheres  with 
the  constructed  contact  force  model.  The  relwve  indentation  equanon  of  motion, 
m"*  5  •  -f .  with  Its  corresponding  initial  condmons.  and  the  developed  contact  force 
model  of  Figure  4  are  mtegrated  fomard  m  dme  until  the  separation  ume.  This  results 
m  a  relative  departing  velocity.  S'"’,  of  0.21  m/s  and  a  duianon  of  contact  of  130  qs, 
which  IS  very  close  to  the  ex^nmental  value  of  I3S  ns. 

The  soluoon  for  vanauons  of  indentauon.  indentation  velocity,  and  mdentaaon 
acceleranon  versus  ame  ts  shown  in  Figure  5.  If  a  piecewise  analysis  with  the 
coefficient  of  tesatuaon  of  0.7  is  j^ormed,  the  relanve  departing  velocity  of  the  two 
spheres  is  obtamed  as  i'"’  •  -ei  ’  *  -0.21  m/s.  Comparison  with  5'*’  from  Figure 
5A)  shows  that  the  results  from  a  continuous  analysis  and  a  piecewise  analysis  match 
closely.  The  energy  dissipated  m  impan  can  also  be  evaluated  as  AT  =  1.06(10'‘ )  J. 
Also,  the  approximate  expression  of  equanon  (15)  for  the  duianon  of  contact  results  m 
a  value  of  At  -  t*”  - 1<>  a  152  qs.  The  apparent  difference  between  this  approximate 
value  and  of  the  expenmental  value  of  135  qs,  is  due  to  the  fact  that  the  resnniaon 
period  IS  reladvely  Sorter  than  the  compressioa  period. 


«.W  f.M  •.!«  f.lS 
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Figure  5.  Results  from  a  connnuous  analysis  of  the  two  aluminum-spheres  impact. 

Time  vanauons  of:  (a)  relative  tndenia&on,  (b)  relative  mdentaaon  velocity, 
and  (c)  relanve  mdentaaon  acceleranon. 


3.  Generalization  to  Multibody  Impact 

We  now  generalize  the  preceding  discussion  to  an  impact  situation  within  a  mulubodv 
system.  Let  the  two  colliding  bodies  be  "r  and  "j"  in.  the  system  of  Figure  6  The 
pomts  of  contact  on  the  two  bodies  are  P,  and  P„  and  n  is  a  unit  vector  in  the  normal 
direcaon  to  the  contact  suinces  of  the  two  bodies.  No  matter  which  type  of  coordinates 
are  used  to  assemble  the  enuaaons  of  mouon  for  the  multibody  system,  the  coordinates 
and  the  velocities  of  the  bodies  can  be  calculated,  at  any  instant  of  nme.  from  the 
soluhon  of  the  equanons  of  monon.  For  a  known  system  configuranon  at  the  ininal  ame 
of  contact,  the  locanon  of  the  contact  pomts  r,''"’  and  r,'*'*  and  the  components  of  the 
algebraic  umt  vector  n,  with  respect  to  a  non-moving  xyz  coordinate  system,  may  be 
calculated.  From  the  known  ngid  body  velocines.  velocmes  of  the  contact  points  m  the 
xyz  coordinate  system,  f,"'’  and  r^'<'>,  may  also  be  calculated  at  that  nme.  Hence,  the 
indentanon  and  the  mdentaaon  velocity  at  the  tmnal  ame  of  contact  are 


i‘  ’  •  n'  f  -  r”-’]  .  (17) 

m  which  the  symbol  T  performs  the  transpose  operanon  and  velocines  of  the  contact 
pomts  are  projected  m  the  normal  direcaon  to  the  contact  surface.  The  expression  m 
equanon  (2)  for  the  parameter  K  can  be  used  for  the  conaict  between  any  two  bodies  if 
the  local  surfaces  of  contact  are  both  sphencally  shaped.  Similar  expressions  have  been 
obnuned  by  Hettz  [9]  and  others  (7,  19]  for  other  shapes  of  the  local  contact  surfaces 
such  as  sphere  on  plane,  parallel  cylinders,  and  plane  on  plane.  Once  the  generalized 
parameter  K  IS  calculated,  with  a  given  coefficient  of  restitunon  e  and  the  ininal  approach 
velocity  i  ,  all  other  parameters  m  the  contact  force  model  can  be  determmed. 


Figure  6.  Impact  wiihm  a  mulbbody  system 

With  known  vanaaons  of  the  contact  force  dtirmg  the  contact  period,  a  conanuous 
analysis  of  the  system  can  be  performed  simply  by  adding  these  forces  to  the  mulbbody 
system  equanons  of  moaon.  This  analysis  method  provides  accurate  results,  since  all  of 
the  equanons  of  moaon  ate  mtegrated  over  the  period  of  contact.  It  thus  accounts  for 
the  changes  m  the  configuranon  and  the  velocines  of  the  system  dunng  that  penod.  To 
avoid  computanonal  inaccuracies  and  inefficienaes  associated  with  the  integranon  of  the 
system  equanons  of  monon  over  the  penod  of  contact,  scaling  of  the  time  axis  is 
somenmes  performed. 

In  order  to  gain  some  computanonal  efficiency,  we  may  use  an  altemanve  method 
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which  recutres  some  approximation,  that  the  duration  or  contact  penod  is  small  enough 
such  that  the  configuration  of  the  system,  and  therefore,  the  normal  direction  or  impact 
remains  the  same  before  and  after  impact.  The  purpose  of  this  analysis  is  to  represent 
the  two  bodies  "i"  and  "j"  in  Figure  6  by  two  equivalent  panicles  of  Figure  1.  To 
account  for  the  inertia  properties  ot  the  coibdmg  bodies  when  the  equivalent  particle 
model  is  used,  one  must  evaluate  an  effecuve  mass  m/*"'  for  each  body.  /  =  t,  j  Since 
the  body  may  be  hnemaacally  constrained  to  their  bodies  m  the  system,  the  reaction 
forces  at  the  kinematic  joints  affect  the  motion  of  the  body  dunng  the  contact  penod 
The  compensaaon  for  the  effects  of  joint  forces  in  the  evaluation  of  effecuve  mass 
IS  based  upon  whether  an  energy  or  a  Newtonian  approach  is  followed.  Using  an  energy 
approach,  the  effecuve  mass  of  body  */"  is  evaluated  as 

m,"'"  -m,  I!!!  ;  I  ■  i.  j  (18) 

where  m,  and  T,  are  the  mass  and  kinetic  energy  of  body  and  T“”  denotes  ihe  total 
kmeuc  energy  of  all  the  bodies  that  ate  connected  directly  or  indirectly  to  body 
including  body  T  (8).  This  coUection  of  bodies  is  referred  to  as  a  sub-system  associated 
with  body  ■/'.  Note  that  the  kmeuc  energies  in  equauon  (18)  are  only  due  to  the 
components  of  velocity  of  the  bodies  in  the  direcQon  of  impact.  As  a  direct  consequence 
of  Newton's  second  law  of  moPon,  the  effecuve  mass  of  a  body  must  be  a  measure  of 
the  resistance  of  the  body  toward  its  velocity  change.  Hence  in  a  Newtonian  approach, 
the  effecpve  mass  of  each  colUdmg  body  "/■  is  evaluated  in  such  a  way  that  the  menial 
forces  actmg  on  the  body,  m  the  direcuon  of  impact,  would  be  equivalent  to  the  menial 
forces  actmg  on  the  sub-system  contaimng  body  "/*  in  the  direcuon  of  impact;  i.e., 


where  m,  and  are  the  mass  and  the  translauonal  acceleranon  of  body  k,  and  the 
summauon  k  is  over  all  of  the  bodies  in  the  sub-system.  Note  that  the  effecuve  masses 
obtained  by  the  Newtoman  approach  may  or  may  not  be  the  same  as  the  etfecuve  masses 
obtamed  from  the  energy  approach. 

Once  the  calculauon  o.  effecuve  masses  of  the  two  colliding  bodies  is  performed 
nght  before  impact  (at  the  urae  of  imnal  contact),  the  direct-central  impact  model  of  the 
two  spheres  ts  reconsoucted  with  effecuve  masses  ro,*'"  and  m,'*®  and  iniual  velociues 
nt  r,  *  and  n^  The  relauve  indentation  equauon  of  mouon  of  the  two  spheres 
duntig  the  penod  of  contact  then  becomes 


m<*«  j  •  -f 


(20) 


Equauon  (20)  is  a  second-order  ordinary  differenuai  equauon  that  may  be  solved 
numenc^y  dunng  the  penod  of  contact  knowing  Ihe  vanauons  of  the  contact  force  A 
proper  set  of  initial  conditions  at  the  ume  of  imtial  contact  t*‘  is  provided  by  equauons 
(16)  and  (1'^.  The  numencal  iniegrauon  of  equauon  (20)  with  the  developed  contact 
force  model  is  earned  out  unnl  the  surfaces  of  the  two  spheres  modeling  the  two  bodies 
■r  and  'j*  separate  from  each  other 

For  illustiauon  of  impact  analysis  of  a  mulubody  system,  a  study  of  a  vehicle 
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rollover  was  penbrmed.  Simuiaaons  were  performed  to  duoiicaic  expenmeniai  rollover 
test  of  a  venicle  at  30  moh  on  a  FMVSS  208  rollover  cart  impacting  a  water-rilled 
deceicrator  system,  thereoy  throwing  the  vehicle  otf  the  can.  ITie  iniu5  roll  angle  was 
23  degrees  The  vehicle,  at  the  time  of  departure,  had  a  velocity  of  approximaieiv  25 
mph  m  the  iranslaaonai  direction  and  1.5  rad/s  in  the  roll  direction  as  shown  in  Figure 
7.  A  number  of  different  analyses  with  rigid  and  flexible  bodies  have  been  penormed 
on  this  vehicle  [20,  21].  Two  addmonal  simulaaons  relat^  to  the  topic  of  this  paper 
were  also  performed  and  the  results  were  compared  to  those  from  the  experiment. 


Figure  7.  Initial  configuration  of  the  vehicle  for  the  rollover  test. 

In  the  first  simulaoon,  a  piecewise  analysis  was  performed  for  any  contact  between 
the  vehicle  roUbar  cage  and  the  ground.  A  set  of  canonical  impulse-momentum  equations 
was  used  at  the  tune  of  unpact  [6].  At  the  time  of  unput  mtegracon  of  the  system 
equations  of  modon  was  mt^reted  and  the  jump  in  the  system  momenta  were 
calculated.  With  new  momenta,  integranon  of  the  system  equations  of  mooon  were 
restarted.  This  procedure  can  be  summarized  as  follows.  Fust  the  linear  system, 

(22) 

was  solved  for  and  t,  and  then  the  momena  after  impact  was  updated  as: 

pCt  .  pM  .  fTi  (22) 

In  these  equaaons,  (-)  and  (+)  refer  again  to  the  quanoties  before  and  after  impact 
respecnvely,  N  is  a  composite  normal  vector,  e  the  coefficient  of  resmuDon,  q  the 
velocity  vector,  r  the  impulse  due  to  the  contact  force,  n  the  Lagranp  mulnpliers 
assocuited  with  velocity  constiamts,  M  the  system  mass  matrix,  D-  =  [  D",  )',  D  the 

consiramts  facobian  matrix,  and  p  the  vector  of  sj^stem  momenta. 

A  contmuous  analysis  was  then  performed  using  the  Hertzian  contact  force  model 
with  peimanent  indentation.  To  devdop  the  contact  law,  the  curvatures  of  the  rollbar 
at  the  area  of  contact  was  used,  as  shown  in  Figure  8  [19],  The  parameters  m  the 
contact  foice  model  were  detemuned,  and  the  resulting  model  is  shoum  m  Figure  9.  The 
solutions  for  relative  indenranon,  velocity,  and  acceleration  of  the  roUbars/ground  may 
be  deiermmed  similar  to  the  procedure  for  the  two  alununum  spheres  impact.  The 
configuration  of  the  vehicle  dunng  the  rollover  is  shown  in  Figure  10.  Summary  of  the 
results  from  the  two  analyses  and  the  expenment  is  shown  m  Table  1.  As  observed, 
although  piecewise  analysis  is  computanonally  more  efficient,  the  correspondmg  results 
are  not  very  accurate.  This  is  due  to  the  fact  that  the  durauon  of  the  contact  is  large 
enough  (approximately  U  second)  that  significant  changes  occur  in  the  configuraoon  of 
the  system.  In  comparison  however,  the  continuous  analysis  with  the  developed  contact 
model  resulted  in  much  more  closer  results  to  the  experimental  values. 
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Figure  8.  Curvature  used  to  develop  the  contact  force  model  for  roUbar/ground  contact. 


Figure  9.  Shape  of  the  contaa  force  model  for  the  roUbar/ground  contact:  (a)  force 
versus  indentation,  (b)  force  versus  Qme. 


Figure  10.  Rollover  conftgurauon  of  the  vehicle. 


Table  1.  Summary  of  the  result  from  experiment  and  analyses  of  the  vehicle  rollover. 


Variables 

Piecewise 

Continuous 

ExDcnment 

Vertical  acceleration  (a) 

5 

17 

15 

First  contact  dutanon  (s) 

0 

0.15 

025 

Settling  nme  (s) 

2.8 

3.0 

3.0 

CPU  lano 

1.0 

2.7 

— 

4,  Parameter  Optimization  of  the  Contact  Force  Model 

Reducing  the  seventy  of  an  impact  to  a  system  is  a  significant  aspect  of  the  engineenng 
design.  This  requires  reduction  of  the  contact  forces  and  their  etfect.  An  opumizauon 
methodology  can  be  formulated  for  the  selecuon  of  the  proper  parameters  in  the  coniact 
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torce  model  so  as  to  minimize  the  maximum  value  of  the  contact  force.  Consider  the 
two-paracle  model  of  any  impact,  shown  in  Figure  1,  for  which  a  single  differennal 
equauon  of  raonon  in  the  direction  of  reianve  mdentahon  of  the  contact  surfaces, 
equation  CO)  has  oeen  written.  The  opamizauon  methodology  was  formulated  as: 

Objeeuve  Funcuon  Minimize  |  \  (24) 

Subject  To  :■  5  S  A 

where  5^  represents  the  maximum  acceleration  of  the  system  equivalent  mass  under  the 
action  of  the  contact  force,  and  A  is  a  limit  on  the  amount  of  relative  indentanon.  A 
solution  to  this  problem  was  obtained  using  the  method  of  modified  feasible  direcnon  for 
constiamed  mmimization.  A  numerical  integrator  was  used  at  every  design  iteration  to 
obtam  the  system  dynariuc  response  for  a  given  set  of  design  variables. 

As  an  example,  the  preying  steps  were  applied  to  a  vibro-impact  system  of 
equivalent  mass  of  6  kg,  initial  relative  impact  velocity  of  O.S  m/s,  and  a  limit  of  5  S  cm 
on  the  amount  of  reianve  mdentanon.  The  nonlmear  Hertzian  viscoelasnc  model  of 
equanon  (4)  was  used  to  represent  the  contact  force.  The  opnmizaaon  problem  of 
equanon  (24)  was  solved  for  the  system,  for  which  the  design  vanables  were  the 
parameters  K  and  m  die  contact  force  model.  The  opnmized  parameters  were 
determined  as: 

K  =  685.7  Wm‘-^;  n  =■  9,428.6  N.s/mV 

under  which  the  resulting  peak  value  of  maximum  acceleranon,  |  \  was  4.2  m/s’ 

Diagrams  for  the  contact  force  versus  mdentanon,  when  opnmal  K  and  q  are  used,  ate 
shown  m  Figure  ll(z),  A  sample  diagram  for  non-opnmal  parameters  is  also  shown  m 
Figure  11(b).  It  can  be  observed  that  the  peak  contaa  force  is  greatly  reduced  for  the 
opnmal  case.  Also,  the  system  with  optimal  parameters  tends  to  dissipate  mote  energy 
than  the  non^optimal  one  dunng  the  pmod  of  the  contact. 

To  snidy  the  effect  of  imdal  impact  veloaty,  the  opnmizaiion  problem  was  then 
solved  with  a  few  different  initial  velocities.  Table  2  summarizes  some  of  the  results, 
from  which  it  can  be  observed  that  at  higher  velocines  both  stiffoess  and  dampmg 
characteristics  must  increase  m  order  to  reduce  the  maximum  acceleration  and  to  keep 
the  amount  of  mdentadon  below  a  certain  limit.  The  resulnng  peak  acceleranon  also 
increases  for  mcteasuig  uunal  impaa  velocity.  As  observed,  the  opnmizanon  procedure 
can  provide  usetul  informanon  on  the  compliance  requirement  of  crashworthy  matenals. 


Figure  11  Force  versus  displacement  diagram  for  the  system  with  (a)  opnmal 
parameters,  (b)  non-opnmal  parameters. 
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Table  2.  Opamal  Coetficieins  for  ihe  nonlinear  Herman  Viscoelasuc  model 


V.  (m/s) 

K(N/m“) 

u  (N.s/m-*  1 

1  3_..  1  (m/s‘  1 

0.5 

685  7 

9428  6 

4.22 

2 

1  0 

2285.7 

20000 

16  89 

3 

1.5 

9142.9 

24285.7 

38.41 

S.  Applications  to  Crash  Responses  of  Aircraft  Occupant/Structure 

As  an  applicanon  of  the  theory  discussed  earlier,  the  crash  responses  of  '-icraft 
occupant/structutB  will  be  presented.  To  improve  aircraft  crash  safety,  condtnons  -nncai 
to  occupants  survival  during  a  crash  must  be  known,  hi  view  of  the  importance  of  this 
problem,  studies  of  posKtash  dynaime  behavior  of  vicums  art  necessary  in  order  to 
reduce  severe  mjunes.  In  this  study,  crash  dynamics  program  SOM-LAfTA  (Seat 
Occupant  Model  •  Light  Aircraft  /  Transport  Aircraft)  was  used  {13,14].  Modiiicauons 
were  performed  m  the  program  for  reconstrucnon  of  an  occupant’s  head  impact  with  the 
mtenor  walls  or  bulkhead.  A  viscoelastic-type  contact  force  model  of  exponenoal  form 
was  used  to  represent  the  compliance  characteristics  of  the  bulkhead.  Correlated  studies 
of  analyncal  simulations  with  impact  sled  test  results  were  accomplished.  A  paramemc 
study  of  the  coefficients  m  the  contact  force  model  was  then  performed  m  order  to  obtaut 
the  conelahons  between  the  coefficients  and  the  Head  Injury  Criteiu.  A  measure  of 
opamal  values  for  the  bulkhead  compliance  and  displacement  requirements  was  thus 
achieved  in  order  to  keep  the  possibility  of  a  head  mjury  as  little  as  possible.  This 
uiformanon  could  In  turn  be  us^  in  the  selection  of  suitable  materials  for  the  bulkhead, 
mstrument  panel,  or  intenor  walls  of  an  aircraft.  Before  mtroducmg  the  contact  fotce 
model  representm^  the  occupant  head  impacting  the  intenor  walls,  descnphons  of  impact 
sled  test  facilihes,  mulhbody  dynamics  and  fimte  element  models  of  the 
occupam/seat/restrauit  system,  dupUcanon  of  expenments,  and  measure  of  head  mjury 
are  provided. 

V  5.1  IMPACT  SLED  TEST  FACmriES 

> 

I  In  order  to  evaluate  the  dynamic  performances  of  the  occupants  and  seats,  the  impact  sled 
I  facilities  at  Nahonal  Insatute  for  Aviation  Reseanch  (NIAR)  are  used.  The  honzontal 

(impact  test  sled  moves  on  a  23.8  meter  track  and  has  a  maximum  speed  of  24.5  m/s. 

It  runs  on  piasac  shoes  and  is  pneumatically  propelled.  The  sled  can  attain  its  maximum 
4  acceleration  withm  fifty  feet  of  its  travel.  Steel  str^  are  placed  at  the  end  of  the  track 

I  to  bnng  the  motion  of  the  sled  to  an  end  as  shown  m  Figure  12. 


Anthropomorphic  dummies  are  used  as  occupants  in  the  sled  test  expenments. 
There  are  standard  SO'*  pocennle  (part  572)  dummies,  which  represent  an  average  male 
of  weight  79.4  kg  and  height  1.75  meters.  A  95'*  percentile  dummy  is  also  available, 
which  represents  an  average  male  who  weighs  90.7  kg  and  has  a  height  of  1.38  meters. 
These  dummies  have  openings  m  their  head,  venebral  column  (lumbar)  and  femur.  By 
fixing  accelerometers  and  tiansducers  mside  these  openings,  the  acceletanon  responses 
of  head,  lumbar,  and  femur  can  be  determined  during  an  impact  test. 

To  conduct  an  impact  sled  test,  the  dummy  is  first  restrained  to  a  seat  with  a 
suitable  restraint  system  and  the  seat  is  mounted  on  the  sled.  The  sled  is  allowed  to 
accelerate  to  the  r^uired  value  and  then  it  coasts.  The  impact  then  occurs  in  the  foim 
of  a  deceleration  pulse  produced  by  the  sled  probe  colliding  with  a  number  of  steel 
straps.  In  aMdon  to  the  data  &om  the  accelerometers,  the  displacement,  velocity  and 
acceleration  of  the  dummy  are  recorded  and  evaluated  using  a  high  speed  video  system 
and  opdcal  target  tracking  techniques.  Visible  marks  (targets)  are  attached  on  different 
parts  of  the  dummy,  seat  and  sled.  During  the  modon  of  the  sled,  the  targets  are  tracked 
by  a  video  camera.  An  Ektapro  1(XX)  mouon  analyzer  is  used  to  record  the  monon  of 
the  targets.  The  analyzer  is  capable  of  recording  1000  frames  per  second.  From  the 
resulting  photogiaphs,  the  muh  of  mouon  of  the  targets  can  be  determined.  A  software 
pukage  called  Monon  Pro  is  utilized  to  digitize  the  modon  recorded  ftom  the  high  speed 
video  cameras  by  collecting  coordinates  of  the  points,  centroids,  angles  and  line 
segments.  To  overcome  the  difficulties  of  manual  iz.'get  tracking  and  also  reducuon  of 
noise  m  the  collected  date,  a  simple  automated  tatjfit  tracking  piocedure  has  also  been 
developed  [22], 

5.2  MULTtBODY  DYNAMICS  MODEL  OF  THE  OCCUPANT 

Program  SOM*LA/TA  incorporates  a  dynamic  model  of  human  body  and  a  fimte  element 
modlElaftheseat  structure.  The  program  is  intended  to  provide  the  designer  with  a  tool 
which  can  analyze  the  structural  demena  of  the  seat  as  well  as  the  dynamic  response  of 
an  occupant  during  a  crash.  Both  two-  and  three-dimensional  occupant  models  are 
available.  The  user  can  select  the  type  of  occupant  from  the  available  opnons,  which 
are;  standard  50*  percentile  male  human,  standaid  50*  percenole  dummy  (part  572), 
nonstandard  human,  and  nonstandard  dummy.  The  two-dimensional  model,  which  was 
mvesogated  in  this  study,  is  represented  by  11  rigid  bodies/segments,  and  constitutes  11 
degrees-of-fieedom  (Figure  15).  The  segments  represent  the  head,  upper  and  lower 
torso,  pelvis,  upper  arms,  forearms,  thighs,  and  lower  legs.  The  model  is  also 
contigured  to  include  beam  elements  m  both  the  torso  and  the  neck.  This  provides  a 
measure  of  the  vertical  loads  experienced  by  the  occupant,  in  aircraft  accidents. 
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Figure  13.  Two*<iimcnsionai  model  of  ihe  occupant  [131. 


Tlie  rotor  cup,  elbow,  pelvic,  knee,  and  head/neck  joints  are  hinge-type 
connections,  Rotaaons  at  the  jomts  ate  resisted  by  torsional  spnng-dampets  whose 
charactensbes  depend  on  the  user  selection  of  human  or  dummy  occupant.  External 
loads  are  apphed  to  the  body  segments  by  the  seat  cushion,  the  floor,  and  by  the  belt 
resoaints.  ^h  of  the  forces  acts  normal  to  the  contact  surface,  FiicQon  forces  are  also 
applied  by  the  seat  bottom  cushion  and  the  floor,  and  in  a  direcoon  opposite  to  the 
tangential  component  of  relative  velocity  between  the  occupant  segment  and  cushion  or 
floor  surftce.  Different  types  of  restraint  systems  can  also  be  modeled.  They  are  lap 
belt,  only  attached  to  either  the  airframe  or  the  seat,  diagonal  shoulder  belt  over  the  right 
or  left  shoulder  attached  to  either  the  airframe  or  the  seat,  double  shoulder  belt,  and 
double  shoulder  belt  and  lap  belt  tiedown  soap.  These  exerted  forces  on  the  occupant 
are  evaluated  based  on  the  geometrical  (ellipsthdal,  spherial,  and  cylindrical)  shapes  of 
the  body  segments.  From  these,  the  impact  between  the  occupant  and  the  aircraft 
interior  can  be  predicted,  A  quasi-static  ^uilibnum  for  flmte  element  method  in  the 
mcremental  form  is  used  to  determine  the  seal  structure  responses.  The  seat  is  modeled 
with  triangular  plate  elements,  beam  elements  and  springs.  Large  plastic  deformations, 
as  well  as  localized  buckling  of  bending  members  can  be  predicted,  Matenal 
nonlineanty  is  treated  using  elasto-plastic  b^vior  and  internal  releases.  At  any  time 
during  the  simulation,  incremental  displacements  of  the  seat  structure  is  obtained  from 
the  external  forces  and  on  updated  tangential  stiffiiess  matrix.  Total  displacements  of  the 
seat  are  obtained  by  summation  of  all  the  incrememal  displacements.  For  dynamic 
formulation,  a  set  of  Lagrange's  equations  of  motion  in  terms  of  independent  or 
generalized  coordinates  is  formulated  and  numerically  generated.  The  differential 
equanons  of  motion  are  converted  to  a  set  of  fiist-order  ordinary  differential  'quaoons. 
The  fourth  order  Runge-Kutta,  as  a  starter  and  the  predictor-corrector  scheme  of  Adams- 
Bashforth/Adams-Moulion  with  adjustable  step  size  is  used  as  the  numerical  integrator. 

In  order  to  investigate  the  compliance  and  displacement  characteristics  of  the 
aircraft  bulkheads,  an  envelope  was  included  for  both  the  occupant  and  the  seat.  The 
pa:,imeteis  of  the  contact  force  model,  as  will  be  discussed  later  in  this  paper,  were 
adjusted  to  obtain  optimum  compliance  and  displacement  requirements. 

Since  the  farces  produced  by  the  neck  of  the  occupant  model  are  also  not  clearly 
represented,  ftirther  modifications  are  being  earned  out  in  order  to  replace  the  baun 
element  of  the  neck  with  an  efficient  discretized  neck  model.  Both  two  dimensional  and 
three 

dimensional  models  will  be  present.  The  two  dimensional  model  has  9  degrees  of 
freedom,  and  the  three  dimensional  model  has  36  degrees  of  fteedom.  The  model 
includes  the  skull  and  the  seven  vertebral  elements  (cervical).  The  model  shown  in 
Figure  14,  is  based  on  the  detailed  cervicle  model  of  Men^  et  al.  [23],  Another 
modification  is  construction  of  a  brain  model,  based  on  the  principles  of  hydrodynamics 
(squeeze  effects).  The  basic  model,  representing  the  skuU-brain  mieracnon  of  Figure 
14,  snidies  the  effects  of  two  spherical  bodies  with  fluid  between  them.  For  such  a 
model,  the  pressure  p  and  corre^nding  teacuon  force  f  developed  inside  are  calculated 
usuig 
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where  n,  is  the  viscosity  of  the  fluid:  V  the  velocity  of  the  inner  sphencai  body;  R  the 
radius  of  the  inner  sphencai  body;  e  the  eccentncity  rauo:  c  the  radial  clearance,  and  S 


An  important  measure  of  injury  to  an  occupant  m  an  aircnfi  accident  is  the  amount 
of  load  transferred  to  the  occupant  lumbar  spme  [24].  The  two  dimensional  occupant 
model  uQlires  a  typical  load-^ecaon  formula  of  an  intact  lumbar  ^me  veitural 
column  to  predict  the  axial  load  and  moments  acting  on  the  lumbar.  This  results  in  an 
incorrect  representation  of  the  dynamic  responses  produced  by  the  |q>inal  column  during 
an  impact.  In  order  to  predict  the  internal  forces  and  moments  in  the  spme,  a  fimte 
element  model  has  been  incomrated  into  the  occupant  model.  To  u.’ercome  the 
problems  of  instability  and  ineKciency,  a  quasi-scmc  methodology  has  been  developed, 
which  combines  the  tinite  element  methods  with  ngid  mulbbody  dynamics  pnnciples. 
A  descnpoon  of  this  methodology  ts  provided  next. 

In  finite  element  analysis,  the  loads  will  generally  be  thought  of  as  bemg  applied, 
while  the  displacements  are  thought  of  as  resultmg.  However,  m  analysis  of  mulbbody 
responses,  it  often  happens  that  we  luve  mixed  boundary  condibons.  An  example  of  a 
mulbbody  system  consistiiig  of  three  bodies,  two  ngid  bodies  connected  by  a  flexible 
body,  is  shown  m  Figure  15.  Here,  body  'i*  represents  the  pelvis,  body  the  thorax, 
and  body  *k‘  the  lumbar  spme. 


Figure  15.  Flexible  body  connecbng  two  rigid  bodies. 

While  performing  a  dynamic  analysis,  the  configuranon  of  the  ngid  bodies  and 
hence  the  displacements  of  nodes  1  and  2  of  the  flexible  body  are  known.  The  problem 
IS  to  find  the  deformed  shape  of  the  enure  structure  and  also  the  forces  and  moments 
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acnng  on  the  ngid  bodies  by  the  deformable  body.  The  quasi-staac  approach  is 
formulated  by  rearianjmg  external  forces,  displacements,  and  the  smictural  saffness 
matrix.  To  solve  the  structural  equilibrium  equanons  for  the  unknown  forces  and 
displacements,  let  us  paraaon  the  known  (k)  and  unknown  (u)  variables  as 


'f.  ' 

5. 

. 

where  matrices  Ku,  Kt,.  and  K.  are  sub-mamces  of  rearranged  smicniral  saffness 
matrix  K.  is  a  vector  of  known  forces  acong  on  the  spme.  F,  a  vector  of  unknown 
forces  acang  at  the  ends  of  lumbar  spine,  2q,  a  vector  of  unknown  displacements  of 
lumbar  spine,  and  5q,  known  displacements  of  nodes  1  and  2  calculated  from  the  ngid 
body  dynamics.  The  unknown  di^lacements  and  forces  can  be  determuied  as 

«<!.  -  K.-{  F,  -  K„  5q, )  (28) 

F.  *  •  (29) 

The  forces  F,  with  some  addiaonal  dampmg  are  included  in  the  rigid  body  dynamics 
equanons  of  motion.  Using  this  methodology,  a  finite  element  model  of  the  lumbar  spme 
was  mcorporated  in  the  occupant  model,  and  the  loads  acong  on  the  spme  were 
calculated.  Preliminary  results  show  that  the  new  spinal  model  can  work  successfully 
as  compared  to  expetimenod  data.  Further  invesdganons  are  being  conducted  in  order 
u  construM  a  laymd  model  with  alternate  discs  and  vertebrae. 

5.3  DUPUCATTON  OF  EXPERIMENTS 


Some  experimental  soidies,  including  decelention  sled  tests  with  forward-facmg  and 
mtchconngurations  were  performed  at  avilAeroModical  Insotute  (CAMO  [13,14]  and 
Naoonal  Insotute  for  Aviation  Research  (NIAR)  to  validate  the  SOM-LA/TA  model.  A 
sample  of  the  results  from  the  CAMl  tests  and  those  of  the  simulations  is  shown  in 
Figure  16.  The  figure  shows  the  time  history  of  pelvis  resultant  acceleraoon  of  a  SO* 
peromole  male  dummy  (flYBPJD  n)  seated  over  a  general  aviation  seat  m  a  forward- 
facing  test.  The  input  de^eraoon  pulse  had  a  oapezoidal  shape  with  12  g  amplimde  and 
ISOms  dutacon.  The  sled  velocity  nghi  before  impact  was  approximately  14  m/s.  As 
shown,  the  results  from  the  computer  simutaoon  match  the  experimental  results  well. 


Figure  16.  Dummy  pelvis  resultant  acceleraoon  versus  ume. 
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Some  tests  have  also  been  perfomed  at  the  Impact  Dynamic  Laboratory  of  NIAR  and 
have  been  duplicated  usmg  the  developed  analysis  capabiliues.  As  an  example.  Figure 
17  shows  the  resultant  head  acceleranon  of  a  HYBRID  H  dummy  versus  nme.  The 
deceleranon  pulse  corresponds  to  Federal  Avianon  Regulations  Pan  23_Test_l  for  a 
passenger,  which  is  a  15g  triangular  pulse  with  I20ms  duration.  The"  dummy  was 
restrained  usuig  a  lap  belt  to  a  ngid  seat  at  60  degree  pitch  configuraaon.  As  observed, 
the  results  tom  both  analysis  expenment  match  closely. 


o 


Figure  17.  Dummy  head  resultant  acceleranon  venus  nme. 
5.4  HEAD  MURY  CRTTERIA 


It  is  well  iwccgnized  that  a  head  impaa  produces  both  translanonal  and  rotanonal  monon 
as  well  as  deformatioa  of  the  skull.  Resultant  brain  mjury  may  occur  from  both  absolute 
monon  of  the  bram  and  its  reladve  displacement  with  respect  to  the  skull.  At  present, 
there  are  several  physical  parameters  used  in  the  evaluanon  of  head  injury,  mcluding 
tiansianonal  and/or  rotanonal  acceleranon  levels  of  head  impact,  impact  force,  velocity 
and  kmenc  energy,  impulse  and  impact  duranon,  etc.  These  measures  have  been  widely 
used  for  animal,  human  cadaver,  and  dummy  expenmental  data  to  determine  tolerable 
and  survival  thr^olds  for  head  impan  in  translanon  or  rotanon.  Other  parameters  such 
as  skull  displacement  and  stresses,  brain  pressures  and  strams,  as  well  as  neck 
snetch/strain  are  usually  related  to  analytical  and  expenmental  head  model  studies. 

Head  Injupr  Criteru  (KQ  is  generally  accepted  as  an  indicator  of  the  likelihood 
of  severe  head  injury  and  is  deternuned  ftom  [25] 


HIC  - 


where  t,  and  tj  are  the  imtial  and  final  integrauon  dmes,  respecnvely,  and  a(t)  is  the 
resultant  head  acceleration  (g)  verses  nme  (s)  curve  for  the  head  strike.  The  HIC  is  a 
method  for  defiiung  an  acceptable  limit;  i.e.,  the  maximum  value  of  the  HIC  should  not 
excerf  KXX).  It  is  pan  of  the  Federal  Motor  Vehicle  Safety  Standards  (FMVSS)  and 
Federal  Avianon  Rcguiahons  [24],  Program  SOM-LA/TA  computes  the  HIC  by  a 
moving-window  integranon  of  the  data  and  a  specific  choice  of  data  sampling. 
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5.5  CONTACT  FORCE  MODEL 


To  usess  our  capabilities  ui  predicting  HIC  during  a  head  impact  with  the  bullcheads  of 
the  aircraft,  seveiai  analyticaj  simulanons  were  performed  and  the  results  were 
compaied  with  those  of  a  dynamic  test  earned  out  at  CAMI.  The  protocol  in  the 
eiipenment  was  developed  to  measure  the  head  path  and  velocity  fiom  an 
anthropomoiphic  test  dummy  (ATD)  restrained  in  a  passenger  seat.  A  mocicup  of  a 
vertical  wall  m  front  of  the  seat  was  included  m  the  futures.  The  distance  between  the 
seat  end  and  the  bulkhead  was  0.9  meters.  The  test  setup  is  shown  in  Figure  18.  The 
input  pulse  was  of  a  triangular  shape  with  a  maximum  value  of  16.9  g  and  a  span  of  160 
ms.  The  velocity  of  the  sled  at  the  ante  of  impact  was  14  m/s.  A  rigid  seat  was  selected 
m  order  to  eliminate  the  effects  of  the  seat  response  on  the  occupant  performance.  The 
rigid  seat  consisted  of  two  pianes  that  represent  the  seat  pan  and  the  seat  back.  Cushions 
were  mcluded  on  the  top  of  the  seat  pan  and  seat  back  surfaces.  The  seat  pan  remained 
fixed  in  the  aircrafi  floor  and  the  seat  back  was  permitted  to  rotate  forward  about  a 
transverse  hinge  axis  at  the  base  of  the  back  if  pushed  from  behind.  A  standard  50* 
percentile  dummy  (FAA  required)  was  then  chosen  u  the  occupant. 

Senes  of  analytical  studies  were  then  performed  to  match  the  results  from  the 
CAMI  test.  Figure  19  shows  the  head  strike  impact  from  simuiadon  at  different  ffames. 
In  order  to  aw-«  the  compliance  characteristics  and  displacement  requirement  of  the 
aircrafi  bulkheads  that  minimize  injuries  as  a  result  of  a  head  contact,  an  envelope  for 
the  occupant  and  seat  was  generated,  and  a  more  accurate  contact  foice  model  was  also 
developed. 


Figure  13.  Test  set-up  of  a  vertical 
wall  in  front  of  the  seat 


To  match  the  expenmental  results,  a  nonlinear,  viscoelastic-type  contact  foice 
model  was  us^  such  that  the  contact  force  f  was  calculated  from  the  deformanon 
(indentanon  )  6  and  deformation  late  (  according  to 

f  .  A(e“-  1)  *  CS 

for  which  A  and  B  are  the  stiffness  coeffiawits,  and  C  is  a  damping  coefficient.  Other 
models  including  linear  viscoelasuc,  Hertzian  with  damping,  and  Hertzian  with 
permanent  indentation  were  also  considered.  However,  the  contact  force  model  of 
equation  (31)  correlated  best  with  the  expenmental  static  tests  done  on  different  tiding 
maienals  For  different  matenals,  based  on  the  static  tests,  coefficients  A  and  B  are 


S46 


evaluated  from  expenmental  correlations.  For  the  damping  force,  the  damping  tano  is 
taken  to  be  constant  for  all  the  deformaaon  modes  of  interest.  This  reduces  the  Raleigh 
formulanon  of  the  damping  coefficieni  to 

C  •  2ka 

where  k  is  the  gradient  of  the  contact  force-deflection  curve;  i.e.,  k  =  ABe“.  Vanable 
a  IS  a  representaave  constant  for  the  system,  and  is  evaluated  as 

o  -  ^  .  -Es-  (33) 

2K,  2AB 

where  Co  and  k^  are  nupecnvely  the  dampmg  and  gradient  of  suffness  coefficienis  for 
zero  deflecuon  conation. 

The  contact  force  model  was  then  used  to  detennine  the  occupant  response  as  a 
result  of  a  head  contact  with  the  wall.  The  coefficients  were  vaned  m  order  to  find  out 
how  the  changes  would  affect  the  HIC  and  maaimum  deformation  of  the  front  panel. 
For  values  of  the  coefficienis  A  *  3203  N,  B  “  27.95  1/ra,  Co  ••  175  N.s/m,  the 
analytical  results  maShed  the  expenmental  results  from  CAMI  test.  The  contact  force 
model  corresponding  to  these  values  is  shown  in  Figure  20,  for  both  the  stiffness  pan  and 
the  dampmg  pan.  Varudon  of  different  coefficients  pnxiuced  some  mtsresiing  results. 
When  stiffness  coefficients  A  and  B  are  increased,  HIC  increases  linearly,  while 
maximum  deformation  of  the  ffont  panel  decreases.  However,  when  damping  coefficient 
Co  is  increased,  HIC  decreases  first,  and  then  mcreases  aiTer  a  while  (Figure  21). 
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Figure  20  .  Conoct  force  models:  (a)  stiffness  part;  <b)  dampmg  part. 


Figure  21.  Variations  of  coefficient  Co. 
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This  means  that  for  a  given  value  of  A  and  B.  there  is  a  value  of  Co  that  minimizes  HIC. 
In  order  to  keep  the  head  mjunes  minimum,  the  value  of  C,  should  be  87.5  N.s/m  and 
the  material  for  the  bulkhead,  including  both  frame  and  padding  material,  should  have 
about  0.057  meter  of  maximum  displacement  requirement. 

The  parameters  A.  B  and  Q,  m  the  contact  force  model  were  then  opnmized  by 
subjecting  the  bulkhead  defotmaaon  5  to  be  less  than  0.057  meters  and  then  mmimizing 
the  bulkhead  acceleration  |5|.  Following  the  procedures  of  section  4.  the  optimized 
parameters  are  A-  61.7  N,  B>'2.3  1/m  and  Co^  491.32  N.s/m.  Figure  22  shows  the 
variation  of  contact  forces  at  the  opnmum  soffheas  and  dampmg  properties.  Materials 
are  being  searched  now,  that  have  similar  amount  of  energy  dissipanon  capability. 


Figure  22.  Variadoa  of  contact  force  at  optimum  stiffness  and  dampmg  properties. 

Based  on  the  preceding  discussions,  a  drop  tower  was  designed  to  simulate  the  head 
strike  on  the  pinm  (Fi|uie  23).  This  facility  consists  of  a  dummy  head  assembly, 
holding  assembly,  a  wire  rope  guided  system,  and  an  impact  absoroer  (panel).  The 
velocity  of  the  system  depends  on  the  height  from  which  the  dummy  head  is  allowed  to 
fall  freely  due  to  gravity.  The  acceleration  is  determined  by  fixing  accelerometers  inside 
the  dummy  head.  Two  wire  ropes,  controlled  by  motors,  are  used  to  raise  the  head 
assembly  to  the  requited  height  mm  the  ground  level.  The  attainable  veloaty  ftom  this 
method  vanes  frern  5.2  m/s  to  17.4  m/s.  For  a  given  velom^,  the  head  is  dropped  onu> 
the  absorber,  and  the  amount  of  crush  left  on  the  absorber  is  reconled.  For  example, 
to  attain  an  impact  velocity  of  14  m/s,  the  head  is  released  from  a  height  of  10  m.  Based 
on  the  earlier  discussions,  an  absorber  that  has  a  crush  of  less  than  5.7  cm  is  an 
acceptable  one.  For  justification  of  the  results,  the  HIC  is  also  evaluated  from  the 
accelerometer  data,  which  has  to  be  less  than  a  value  of  1000. 


6.  Conclusion 

A  continuous  analysis  method  has  b*"  presented  for  the  direct-central  impact  of  two 
solids.  To  represent  the  variation  of  the  contact  force  during  the  contact  penod,  two 
Hertzian  models  are  used,  one  with  hysteresis  dampmg  and  one  with  local  plasticity 
effects.  At  low  impact  velocities,  energy  is  dissipatM  m  the  form  of  internal  damping 
or  heat.  If  the  imoal  indentanon  velocity  is  not  negligible  compared  with  the  propagauon 
speed  of  defontianon  waves  across  the  solid,  then  permanent  indentanon  is  the  dominant 


factor  accounting  for  energy  dissipaaon.  For  both  models,  based  on  energy  and 
momentum  consideraoons,  the  unknown  parameters  were  evaluated  in  terms  of  the 
geometncal  and  matenal  properties  of  the  contaa  surfaces,  velocioes  of  the  solids  before 
impact,  and  the  coefficient  of  resdtuuon.  A  procedure  for  impact  analysis  of  muiubody 
systems  was  then  developed  using  the  concept  of  effective  mass.  From  the  companson 
of  the  contmuous  analysis  method  with  a  canonical  set  of  impulse/ momentum  equauons. 
It  is  observed  that  when  significant  changes  occur  m  a  system  configunDon  before  and 
after  impact,  the  use  of  piecewise  analysis  method  is  not  suitable  for  prediction  of 
impact  responses. 

Use  of  impaa  sled  tests  is  the  most  common  technique  for  determining  the  post¬ 
crash  dynamic  behavior  of  an  aircraft  occupant.  The  impact  sled  and  target  tracking 
facilities  available  at  National  Insdtute  for  Avianon  Research  (NIAS)  were  used  to 
condua  a  study  on  occupant  responses  in  a  crash  environment.  Parallel  analysis 
capabilides,  including  a  mulbbody  dynamic  model  of  the  occupant  and  a  fimie  element 
model  of  salt  structures,  have  been  developed.  The  analysis  has  been  used  to 
reasonably  predict  the  Head  Injury  Criteru  (Hl(^  as  compart  with  the  expenmental 
impact  sled  tests  for  an  occupuit  head  imputing  a  panel.  A  nonlinear  viscoelasuc 
contact  force  model  was  developed.  Suitable  values  of  the  coefficients  m  the  contact 
force  model  were  obtained  and  the  cotrelanons  between  the  coefSdents,  HIC,  and 
maaimum  deformadon  of  the  front  p^  were  determined.  A  non-sled  test  method  has 
been  designed  to  determine  the  head  injuries  as  well  as  the  performance  of  a  pamcular 
unpact  absorber. 


Thisresrarch  is  pamalfy /undid  bv  V  S  Dipanmttu  o/Tranipcniuion.  Federal  Aviation  Adminisiration 
Technical  Center,  Atlantic  City  Atrpan,  New  Jertev.  it  is  also  partially  funded  by  Weslev  Medical 
Foundation,  Wichita,  Kdntat, 
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DATA  FTITING  METHODOLOGY 

FOR  FRONTAL  CRASH  VICTIM  SIMULATION 
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ABSTRACT.  The  atm  of  the  paper  ts  to  present  the  methodology  for  dau  fimng  we 
developed  and  followed  to  perform  crash  victim  simulations.  The  project  earned  out  with 
P.S.A.  Peugeot  Citroen  car  company,  consisted  in  modelling  and  String  efficiently  all 
interactions  between  a  dummy  and  a  car  dunng  a  riontid  crash.  This  work  was 
accomplished  on  the  basis  of  standard  crash  expenmental  measurements  without  making 
systematic  ticklish  test  identification  on  parts  of  the  system.  The  final  purpose  is  to 
opnmise  the  safely  equipments.  For  this  study,  we  choose  to  consider  the  dummy  as  a 
ngid  multibody  system  and  to  use  the  program  MADYMO  from  T.N.O.  (Delft) 

-  The  paper  will  first  bnefly  present  the  system  to  model 

•  Then,  mput  and  output  parameters  will  be  identified  and  classified.  The  methodology 
used  to  fit  the  model  to  slM  tests  will  be  presented,  with  the  help  of  a  sensiriviiy  analysis 
and/or  a  rales  system.  We  will  explain  how  this  approach  permited  us  to  coirelate  the 
model  for  very  different  crash  test  configurarioos  widi  the  same  basic  data.  Partial  results 
of  two  simulanons  will  be  shown ; 

-  Hnally,  it  will  be  explained  how  to  take  into  account  m  the  stmulanon  effects  of  a  few 
phenomena  which  occur  m  a  real  crash  and  are  not  desenbed  by  the  theorencal  model. 

1.  Introduction 

Numerical  methods  have  been  recently  mtroduced  for  the  simulauon  of  vanous 
configuration  automotive  crash  tests.  In  this  field  of  mechanical  analysis,  our  aim  is  to 
evaluate  the  coupling  between  the  car  and  the  dummy,  during  a  frontal  crash.  By  usuig  a 
relatively  simple  mo^l,  the  principal  purposes  of  computation  can  be  :  Understanding 
dunng  the  modelling  and  evaluating  the  fitted  system  by  simulation.  Our  paper  deals  with 
this  f^  aspect. 

I.I.  UNDERSTANDINO  DURINO  THE  MODELLING 

-  To  know  what  happens  qualitariveiy  in  a  veiy  shots  time  (0.2  second)  m  terms  of  the 
succession  of  conoct.  defoimation  (s^gs)  and  mouon  of  different  pans  of  the  system. 

■  to  understand  the  behaviour  of  the  dummy  and  the  restraint  system,  meamng  the 
signification  and  the  influence  of  few  global  parameters. 

13  EVALUATING  THE  FUTED  SYSTEM  BY  SIMULATIOT 

-  In  order  to  compare  different  configuruions  of  crashes  using  a  change  of  one  or  several 
significant  parameterfs)  without  malwg  costly  experiments ;  and  with  the  insurance  that, 
excepted  for  wanted  changes,  all  parameters  remain  unchanged. 

■  and  to  evaluate  the  hierarchy  of  the  parameten  and  then  interaction, 

-  to  show  tendency  and  sensitivity  of  the  system  by  governing  parameters. 
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-  and  to  finally  opomise  the  system. 

1  3  A  GENERAL  PROBLEM  FOR  THE  MODELLING 

In  fact  beyond  our  piactical  project,  we  were  aware  of  a  general  problem  dunng  the 
building  of  a  numencal  sunuladon  model.  A  lot  of  standard  methods  and  programs  are  a- 
vailable  today.  The  engineer,  after  having  formulated  his  theorencal  model,  needs  to  find 
Jie  best  input  dau  set  for  a  spe^c  applicauon,  fitting  closely  the  system.  For  that 
purpose,  he  may  analyse  the  experirpeut  data  and  conditions  to  find  some  parameters.  In 
fact,  all  input  data  is  not  easily  identifiable  during  the  experiment  (even  the  geometry),  A 
common  approach  is  to  make  systematic  test  idwtificanon  on  pans  of  the  system,  espe¬ 
cially  for  soShesses.  But  often,  such  a  partial  test  is  very  difficult  to  conduct,  and  it 
provides  data  that  doesn't  fit  well  the  crash  leality  or/and  doesn’t  lead  to  a  good 
simulation.  As  a  consequence,  it  becomes  necessary  to  modify  the  test  data  to  obtain  a 
better  correlation.  With  this  problem  in  mind,  we  choose  to  minimise  the  number  of  such 
tests,  to  make  the  mote  ptaracal  and  reliable  of  them  (example  :  sunc  retractor  or  seat 
pan  stiffnesses)  and  to  manage  the  fitting  of  ticklish  parameters  by  finding  the  best 
coneladon  (example  ;  fiicdon  coefficient).  Even  though  we  knew  that  the  more  the 
system  is  coupled,  the  mote  difficult  is  the  finmulatioo  of  the  data,  we  were  sure  that  this 
approach  will  help  us  to  understand  better  the  phenomenon.  This  approach  justified  the 
monvatlon  m  choosing  a  relatively  simple  model,  with  the  advanuge  of  a  very  shon 
computmg  time  'a  few  minutes  on  a  tinix  station). 


2.  The  system  to  tnndel 

The  interacttoii  between  the  ew  and  the  dummy  is  our  principal  interest  Thus  the  model 
concerns  only  the  dummy  and  its  direct  environment  (Sguie  1).  Even  if  we  began  first  to 
consider  sled  tests,  after  having  noticed  rather  3D  mouon  for  the  dummy  in  car  crashes, 
we  choose  to  built  directly  a  3D  modeL 

The  dummy  is  modelled  by  13  rigid  parts 
(materialised  by  the  skelemn  on  the  sketch) 
which  are  connected  by  12  joints.  Each  joints 
are  spherical  and  owns  complex  angular 
loading  and  unloading  characteristics.  A  cettam 
numba  of  ellipsoids  are  added  to  the  members, 
on  which  a  contact  may  occur.  The  model 
allows  contact  between  ellipsoids  and  ellipsoids 
or  plaiwa.  typically  between  pelvis  and  scan 
foot  and  foot  planes,  chin  and  upper  torso,  arms 
and  legs,  head  and  knees,  etc. 

In  reabty,  there  is  a  defotmanon  when  a  contact 
occurs.  The  model  detects  a  simple  geometnc 
interference  and  generates  a  complex  force 
_  ,  _  ,  ..  functioB  of  the  interference  and  Its  velocity.  For 

fig  1 .  The  dummy  and  its  environment  force-deflexion  law  in  the  model  (joint  or 

contaa).  it  is  possible  u>  introduce  fiicnon, 
damping  and  hysteresis. 

As  can  be  seen  in  the  figure  1,  for  the  environment  we  incorporated  a  scan  a  standard 
3  pomts  seat  belL  a  foot  pan  and  a  toe  board.  It  should  be  nouced  that  for  a  real  car,  it 
will  be  essennal  to  model  the  dash  board. 
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The  belt  may  be  decomposed  in  5  segments,  whose  extiemines  are  on  the  car's  compo¬ 
nents  or  on  the  surface  of  the  dummy.  Each  segment  acts  like  a  linear  spnng  and  owns 
force-deformation  charactensnc.  Between  two  adjacent  segments,  on  the  common 
(buckle  with  null  diameter)  or  distanced  pomts  (contact  on  the  dummy),  there  is  a  close 
relanon  given  by  the  classical  Uw  of  fticnon  (belt  and  pulley)  and  then  a  possibility  for 
the  strap  to  sUp  along  its  route  formed  by  the  different  connected  (so  fixed)  points.  A 
retranor  (film  spool  effect)  may  be  simulated  by  correcting  the  snffiiess  of  the 
corresponding  segment. 

The  analysis  supposes  that  the  car  (or  sled)  is  fixed  to  the  reference  frame  and  •  the 
dummy  is  accelerated  forward  by  the  opposite  of  the  accelcrapon-nme  history.  This  his¬ 
tory  is  measured  and  filtered  on  the  middle  pillar  of  die  c'r  during  a  real  crash  or  sled 
test,  see  figure  9.  We  are  working  with  a  reutive  monon  between  the  car  and  the 
dummy :  Such  a  description  involves  the  neglecting  of  the  car  rotanon  (conolis  effect). 
To  obtain  the  total  acceleradon  on  the  dummy  parts,  the  calculated  accelerenon  and  the 
prescribed  one  have  to  be  added. 

All  this  amects  were  commonly  available  in  the  program  Madymo  (1)  and  have  not 
needed  specific  implemenanon. 
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3.  Data  fitting 

3  1.  DATA  SET  AND  INPUT  PARAMETERS 


The  dynamie  desoipdon  of  the  system  evoked  above,  incluriet  iirr'%  ws  and  contaa 
roopetties.  which  correspond  to  so<alled  global  parameters  (a  sap ’•  vaive  or  a  function) 
These  parameters  may  be  classified  in  2  types  :  Imrinsic  (P,  and  conlix^'anon  Test 
dependent  (T).  By  intrinsic,  we  mean  that  these  parameters  have  to  be  repioduv^ble  with 
one  single  level  This  level  is  fixed  ^  a  certain  technology,  Wv  dun  i  want  to  change, 
dummy  properties  or  fiiction  coefficient  for  example.  Futhetmore,  ano’her  difncnon 
may  be  applied  :•  Validated  (V)  (fiom  reliable  partial  experiment  pr  pttce.;ent  test 
correlations).  Directly  identifiable  (D)  (fiom  the  test)  and  Funy  (F)  at  Uit  avrocot, 

A  first  class  of  parameters  is  available  at  the  beginning : 

-dummy  properties  I  V 

-  dummy  installation  (geometry)  t  D 

-  dummy  environment  (geometry)  T  D 

A  second  class  of  parameten  that  have  to  be  fitted  is  given  wuh  thutr  hier.johy  i 
Main  parameten : 

-Mt  slack  and  toe  board -foot  slack  T  f 

-  belt  segmmits  stiffness  I  F 

Minor  parameters ; 

-seat  and  foot  test  stiffness  I  F 

-  retractor  charactetisuc  I  V 

-  friction  coefficient  between  strap  and  buckles  I  F 

-  friction  coefficient  between  strap  and  dummy  I  F 

•  fticnon  coefficient  for  the  various  contacts  I  F 


Note  that  for  our  simple  model  where  the  dummy  is  modehid  as  npd.  the  unknown 
flexibihty  of  the  upper  torso  and  pelvis  is  incorporated  m  the  belt  segment  chaiactetisncs 
Thus,  It  IS  necessary  to  modify  deeply  the  common  static  force-defonnatjoa  for  the  snap 
(9%  of  defottnanon  under  10  kN). 
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3.1  1.  Inmnsic  parameters.  Dummy  data ;  With  Madymo,  the  model  was  almost  ready  to 
be  used.  A  data  base  for  the  dummy,  we  employed  for  the  sled  test,  namely  the  Pan  572 
dummy,  were  furnished  with  the  code.  It  contams  all  the  validated  dynamic  properaes  of 
the  dummy.  We  found  useful  to  modifv  the  ellipsoids  and  the  location  of  the  accelerome¬ 
ters  proposed  in  the  previous  dau  base. 

The  final  purpose  ts  surely  to  determine  precisely  the  other  intrinsic  and  often  fiizzy 
parameters,  uter  what  they  become  valiuted.  but  a  with  good  portability  of  them  on 
sevoal  tests.  For  the  very  fint  test,  tt  is  also  necessary  to  estunate  them  rougly  using  me- 
chamcal  sense  and  expenencc. 


3.1J.  Test  dependent  parameters.  Dum¬ 
my  insttUaiion  :  The  dummy,  our  ptinci- 
pal  interest,  is  taken  as  the  centre  of  the 
geometric  world  of  analysis.  It  is  not  a 
simple  task  to  place  it  m  a  accurate  posi¬ 
tion  (20  problem),  before  adding  the  other 
elements  around  it.  As  the  dummy  is 
formed  by  rigid  bodies  linked  by  spherical 
joints,  we  must  determme  the  oncntanon 
of  them  and  choose  a  reference  winL  The 
mam  difBculty  concerns  the  loc^anon  of 
the  hindered  joints  for  the  spme.  A  geo- 
merncal  mediod  has  been  us^  assuming 
that  there  is  a  zero  torque  imtially  in  the 
spine's  joints.  As  a  cons^uence,  the  spine 
may  te  considered  lioren  and  one  de^e 

.  „.j.  1.  .1. _ :  of  Becdom  existt  for  the  dummy  position, 

fig  2.  Two  t^ets  to  ^termine  the  position  ^  relative  angle  between  the  glo¬ 

bal  torso  and  the  upper  legs. 

With  the  position  of  two  targets,  respectively  on  the  head  and  knee,  given  by  the  film. 
It  is  very  sunple  to  deduce  analytically  the  H  point  (centre  of  the  |ielvis-upper  tegs  joint) 
and  the  whole  posidon  of  the  dummy  totso  and  upper  legs.  The  other  memben  onena- 
hons  are  identified  fiom  the  film  easily. 

Belt  route  ;  Another  problem  is  to  find  the  routes  of  the  shoulder  and  lap  belts  on  the 
dummy,  with  the  evidence  that  this  routes  often  may  change  during  a  ciash.  correspond- 
mg  to  transverse  slip  not  modelled  in  Madymo.  Another  reason  to  treat  this  problem  ana¬ 
lytically  is  that  sve  wanted  to  simulate  earlier  tests, 
where  the  connectmg  pomts  of  the  strap  on  the  dummy 
were  not  known.  IbOTfoie  we  choore  to  model  the 
route  and  calniliw  geommeal  characterisucs  of  the 
belt  with  a  pre-processor,  in  the  initial  posmon  of  the 
dummy.  It  is  explained  below  how  to  connol  this  pa¬ 
rameter. 

The  emrespoeding  model  is  built  by  assuming  that 
the  shoulder  belt,  as  the  hqi  belt  (example  in  figure  3), 
were  each  contained  in  a  plane  and  that  each  segment 
IS  tangent  to  the  ellipsoid  to  be  considered.  As  the 
plane  must  be  built  with  a  line  formed  by  the  two  an¬ 
chorage  points  (A  and  D),  it  ma)'  be  driven  by  a  suigle 
fig  3.  o.ie  single  parameter  9  to  parameter  as  an  angle  around  this  line.  For  such  a  pa- 
find  the  route  of  the  lap  belt  rameter,  the  pre-processor  provides  the  connecong 
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points  coordinates  on  the  torso,  respectively  the  pelvis  (B  and  C),  and  the  length  of  the 
strap  in  contact  It  is  interesting  to  notice  that  during  the  sunulanon  of  vanous  tests,  the 
maximum  corresponding  plane  default  doesn’t  exceed  3  cm  for  the  shoulder  belt 
Other  elements :  Accmding  to  certain  chosen  geometnc  parameters  (uiinal  equilibn- 
um),  our  pre-processor  computes  the  whole  coordinates  for  the  seat  and  the  foot  planes. 

3  2.  OUTr  JT  PARAMETERS 

Output  parameters  are  commonly  recorded  as  time  histones  during  a  test  They  may  be 
classiiiM  for  the  dau  fitting ; 

Mam  parameters ; 

-  upper  torso  backward  acceleration 

-  Mt  segments  foices 

-  targets  trajectories  (head,  shoulder,  pelvis  and  knee) 

Mmor  parameters  1 

-  the  other  accelerations  (components,  for  the  head,  upper  torso  and  pelvis) 
Ticklish  parameters : 

-  heu  icceleiation  components 

-  head  trajectory  (mainly  at  the  end  of  tiie  crash) 

•  shoulder  traject^ 

33,  MEraODOLOGY 

The  ease  of  data  fitting  is  conditioned  by  the  knowledge  we  have  initially  about  the  com¬ 
mon  input  paiaoMters,  We  shall  explam  how  we  began  this  study  in  an  complete  un¬ 
known.  The  idea  is  to  make  a  first  rough  fitting  and  to  proceed  after  by  refinements.  Ob¬ 
vious!)'.  after  havmg  determined  the  intrinsic  parameters  on  several  correlations,  it  will 
be  easier  and  faster  to  simulate  other  tests. 

3.3.1.  First  rough  fitting  (first  simulation  of  a  first  test).  All  the  parameters  are  ininallv 
esnmated. 

The  first  step  consists  in  cortehuiog  the  upper  torso  backward  acceleranon,  because  it 
is  m  a  close  r^on  with  the  initial  l^ematics  energy  of  the  dummy  and  so  mainly  af¬ 
fected  by  only  2  main  parameters.  Thus,  first  stage ;  the  startmg  time  of  the  acceleranon 
curve  gives  the  global  slack  of  the  belt  (Test.dependut).  Second  stage  :  the  stifthess  of 
the  shoulder  belt  (Innnsic)  is  fitted  by  correlating  in  timing  and  height,  the  maximum  ac¬ 
celeranon  (and  the  miximum  force  m  shoulder  belt  segments  if  measured). 

The  second  step  consists  in  conelating  knee  and  pelvis  targets  trajectories.  Slacks  (T) 
and  sti^ess  (I)  of  the  belt  lap  and  the  toe  board  are  determined  by  the  horizontal  excur¬ 
sions  1  and  stiffiess  (T)  of  the  seat  is  determined  by  the  pelvis  pmtranon.  The  fticnon 
coefficient  (I)  between  the  seat  and  the  pelvis  is  adjusted  m  correlating  the  maximum  of 
lap  belt  force. 

In  a  third  step,  we  may  fit  the  ftrction  coefficients  (I)  concerning  the  belt,  by  coirelai- 
mg  the  vanous  force-time  histories  of  the  belt  segments  and  the  he^  l^et  trajectory. 

For  next  correlations  of  other  tests,  we  shouldn't  modify  the  intrinsic  and  work  out  on¬ 
ly  with  the  test  dependant  psrameten.  If  a  beam'  correlation  is  obtained  by  changing  an 
intrinsic  parameter,  we  have  to  find  an  explanation  of  this,  and  examine  the  effect  of  this 
potential  change  on  the  previous  simulations. 

3.3.2.  Refinement.  As  the  parameters  are  strongly  coupled,  it  is  not  evident  to  find  a  good 
solution  for  the  mput  data  seu  In  changing  one  parameter,  the  whole  output  parameters 
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may  be  affected,  conductuig  to  review  the  other  input  parameters  previously  fitted...  Thus 
It  IS  important  to  proceed  regarding  the  hierarchy  of  the  parameters.  After  a  first  rough 
correlation.  It  becomes  necessary  to  play  with  all  the  parameters.  In  these  condmons.  on¬ 
ly  the  expenence  of  the  engmeer  (or  simple  dckiish  idenDficanon  test)  may  pemut  to 
reach  an  acceptable  soluaon.  Thus  we  choose  to  make  a  senstbviiy  analysis,  which  is  pre¬ 
sented  figure  S  m  a  qualiauve  matru  on  one  hand  and  to  heap  up  observed  effects  of 
changmg  parameters  in  a  formal  rules  system  on  the  another  hand 
For  the  building  of  this  mamx,  we  have  to  make  several  remarks 

-  The  mputs  (one  line)  are  supposed  mcreased  (tuned  up  fom  an  esiuned  to  a  maximum 
feasible  value),  and  we  look  at  the  qualiauve  varianons  of  the  outputs  (reiadve  to  an  ex- 
penmental  scale) :  0  means  no  influence,  -t-  or  -  a  significant  one,  -h-  or  -  -  a  strong  one 
and  +  -  a  non-monotonic  dependancy 

-  We  consider  here  a  parameter  as  a  globalised  data.  example,  at  an  increase  of  the 
belt  stiffness  corresponds  an  amplification  factor  o.\  the  basic  low  (foree-deflexion) 

-  For  the  belt  angle  :  an  uicrease  of  it  provides  higher  conneccng  pouits  on  the  dummy 
ellipsoid  (see  paragraph  3.1.2.) ; 

-  The  f  notanon  is  an  abbrevianon  of  fricdon  coefiicienL 

The  seosiavity  matrix,  regarding  certain  output  parameters,  is  very  useful  in  predicnng 
which  input  parameters  have  to  be  increased  or  decreased  to  obtain  a  better  correlanon. 
However  the  validity  of  the  matrix  keeps  saying  local  and  it  is  therefore  necessaty  to  fur¬ 
nish  an  imdal  approximation  of  the  datt  set  not  too  far  fiom  the  solunon  and  to  up^te 
the  matrin  when  getnng  a  good  experience  of  the  system  behaviour. 

As  the  rules  system  contains  a  lot  of  relations,  it  is 
not  easy  to  present  it  in  this  paper  and  we  give  here 
only  an  eximple,  figure  4.  between  faction  coeffi- 
cient  dummy-strap  iai  head  trajectory :  an  mcrease 
of  the  faction  coefficient  (fi  to  f2)  leads  to  a  reduc- 
/  don  of  the  verdcai  component  of  the  side  view  ira- 

f2  jecio^ofihehead. 

ft _ ^  This  tools,  implemented  at  each  new  test  conela- 

“  fioo.  pemiit^  quickly  to  describe  above  numencal 

results,  phenomenological  behaviour  and  to  un- 
figure  4.  example  of  a  lule  prove  the  daa  set.  with  common  mmnsic  pareme- 

ters  or  with  identified  differences. 


•  Limits  of  the  model 
4.1.  INTRODUCTION 

Several  problems  occur  difang  the  daa  fittmg  approach.  Seme  phenomena,  that  can't 
be  evaluatra  expefimentally  for  a  common  test,  seem  to  influence  shatply  the  behaviour 
of  the  dummy,  and  are  beyond  the  capabUidcs  of  the  model  For  example,  large  rotaoon 
of  the  pelvis  may  introduce  a  global  stiffisess  for  the  contact  with  the  seat,  very  different 
thsn  a  previous  measurement  with  the  pelvis  normally  seated,  liver  for  this  contact,  the 
s’andair'  faction  ti„del,  which  at  a  zero  relanve  speed,  could  only  comspond  a  zero  fac- 
non  force,  leads  to  uniealisnc  acceleration  for  the  pelvis  when  it  begms  to  come  back, 
e-cn  unsabihty.  It  is  beyond  .e  scope  of  this  anicle  to  explain  all  the  numerous  prob¬ 
lems  of  modellmg,  we  had  to  deal  with,  but  the  most  unponant.  that  are  die  pillaiO->)-nng 
clampmg  and  the  toiso  twisung  control. 
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4  2.  PILLAR  RING  CLAMPING 


For  ihc  model  as  the  retractor  part  is  pas¬ 
sive,  slip  at  the  pillar  rmg  acts  every  time,  ex¬ 
cept  dtamg  the  maximum  flat  level,  see  figure 
6.  Thus,  a  simple  friction  relanon  exists  be¬ 
tween  the  tensions  of  the  two  belt  segments : 
Retractor  pan  and  shoulder  upper  belt  These 
forces  latp  growing  always  m  a  ratio  given 
by  the  coefficient  friction  at  the  pillar  ting  and 
the  angle  farmed  by  the  segments  (none  con¬ 
stant).  As  1  consequence  for  the  tune  history : 
Afrer  havuig  caught  the  slack,  the  forces  m- 
ctease  in  this  rano  with  their  maxima  reached 
in  the  same  ome.  After  the  nnTim«  the  retrac¬ 
tor  pan  stands  at  the  same  level  wnen  the 
uppa  pan  begins  to  decrease,  unnl  the  rano  of 
sup  is  reached  again.  Then,  the  renactor  pan 
decreases  too. 

In  the  reaUty  of  a  test,  the  retraaor  pan 
foice-nme  history  doesn't  foUow  the  model.  It 
seems  to  prove  that  the  friction  coefficient  is 
very  small  at  the  begini^g  until  it  uicreases  a 
loL  In  other  terms,  a  clamping  occurs  (c).  The  consequences  of  this  phenomenon  are  se¬ 
vere  for  the  head,  for  which  it  becomes  impossible  to  reproduce  accurately  acccleranon 
and  trajectory.  In  order  to  take  into  account  of  this  phenomenon,  a  high  constant  fricnon 
coefficient  has  to  be  used. 

As  an  example ;  For  the  second  test  presented  in  this  paper,  this  phenomenon  occurred 
surely.  In  the  simulation,  the  head  acceleration  is  lowoed.  and  the  trajectory  mcreased. 
O!  course,  it  would  be  possible  to  correct  the  simulated  tnjectesy  by  reducing  the  belt 
slack,  but  it  would  offset  the  maximum  time  and  petturb  the  correlation  of  the  upper  torso 
acccleranon  too 

4  3.  TORSO  TWISTING  CONTROL 

In  figures  7, 8,  two  series  of  sketches  of.  same  test  simulation  are  presented.  The  only 
difference  concerns  the  miiial  route  of  the  shoulder  belt  on  the  upper  torso.  The  fust  sun- 
ulanon  reflects  a  2D  behaviour.  For  the  second,  the  torso  twisung  is  very  pronounced. 
According  to  our  method  to  desenbe  the  connecting  points  (with  a  single  angle  to  fit  the 
minal  supposed  belt  plane),  we  need  to  be  careful  about  this  parameter  and  to  co.,ool  it 
by  an  agrwment  of  jU  idnematiGS  of  the  dummy  uirso  Of  course  this  control  must  be 
made  during  the  data  fitting  {uocess.  We  must  perns  out  that  this  ticklish  phenomenon  is 
m  reahty  controlled  by  the  initial  position  of  tb.^  belt  on  the  shoulder  and  the  transvetse 
slip.  It  could  be  perhaps  well  modelled  with  a  different  approach  (fimte  elements).  How¬ 
ever  we  think  that  it  is  vital  to  understand  this  global  phenomenon. 

In  the  same  way,  it  ir  necessary  to  connol  the  lap  belt  route,  m  order  to  get  a  good  cor- 
relanon  for  the  parameters  concerning  the  pelvis.  According  to  the  more  or  less  realisne 
rounon  of  this  element  m  the  sunulauon,  the  cenneenng  points  must  be  placed  relanvely 
high  in  the  irnoal  position,  so  thaq  at  the  maximum  tension  ome,  the  route  seems  correct 


time 


O  upper  shoulder  pan 
A  computed  retractor  pan 
□  expoimental  renactor  pan 

figure  6.  Belt  forces-time  histories 


S60 


100  ms 

above '  near  the  neck 

Oguie  8 :  •  influence  of  the  shoulder  belt  route  on  the  dummy  loncmaDcs-  side  view  • 
below :  middle  of  the  shoulder 


100  ms 
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5.  Two  examples  of  correlation 


As  an  illustration  of  this  approach,  we  present  here,  figures  9  to  16.  in  the  annex,  the 
results  of  simuiaaons  of  2  sled  tests,  managed  with  the  same  intrinsic  data  and  methodol¬ 
ogy  presented  in  this  paper.  This  tests  were  leahsed  -n  very  different  configuranon  and 
may  be  seen  as  extremes  at  the  speed  of  48  km/h  impact  (figure  9).  The  second  simula- 
uoii  was  so  severe,  that  it  was  useful  to  reinforce  the  seat  at  his  ffonu  and  a  rigid  rod  may 
be  observed  m  a  simulaoan  (which  interacts  with  the  pelvis).  For  this  test,  we  thuik  that  a 
Piliar-nng  clampmg  occuia,  with  the  difficulty  to  correlate  both  acceleraoon  and  trajecto¬ 
ry  of  the  head. 


6.  Conclusion 

Thanks  to  its  flexibiiity,  good  reliabihty  and  low  computauon  time,  numencal  mulu- 
body  simulanon  can  be  very  useful  m  understandmg  the  global  behaviour  of  a  complex 
mechamcai  system  and  further  m  unproving  iL  However,  ifs  often  a  long  way  to  fit  accu¬ 
rately  a  formulated  model  with  the  cxpenmenL  What  we  attempted  to  do  ptimanly  m  this 
project,  was  to  make  a  systemanc  approach  in  correlating  such  a  model,  in  the  field  of  au- 
tomonve  safety.  We  thought  that  only  a  formulauon  of  consistent  daa  will  permit  to  sim¬ 
ulate  different  configuration  tests  and  mterpret  the  inflaence  of  global  parameters,  before 
perfonmng  more  accurate  but  complex  computanon  with  finite  elements  method,  for  ex¬ 
ample. 
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ANNEX :  Results  of  two  simulations 
Remark :  for  all  histones,  the  nme  unit  is  the  ms. 


•  figure  9.  sled  acceleranon-nme  histones  • 
test  1 :  low  seventy  and  lest  2 :  high  seventy 


experiment 


simulation 


-  figure  10.  Kinematics  for  the  low  seventy  test  • 
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simulation 

expenment 


•  figure  12.  Compaitd  trajectones  • 


567 


simulation 
—  —  —  —  expenment 

•  figure  13.  compared  mne-bcU-forecs  histones  for  the  low  seventy  test  • 
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-  simulation 

—  cxpcnmeni 

•  figure  !4.  compared  tune*belt'(ensiona  histories  for  the  high  seventy  test 
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ABSTRACT.  Tiis  paper  deacnbea  a  methodoloi)'  tor  the  sensitivity  analysu  and  opuinizatlon  of  planar 
constrained  mechanical  systems.  Direct  differenusiioo  methods  and  finite  itfference  techniques  have  been 
used  lnthedesigntensiuvitycaictilaiions.T1ie  c^purmasuon  proceu  is  developed  within  the  framewodc  of 
mathematical  prosrammmf  techniques.  The  sensttivity  equations  were  constructed  symbolically  and 
subsequently  Inieiraied  ta  the  dynamic  analyns  equations  of  motion  and  solved  simultaneously. 

Some  examples  are  solved  to  demonstrate  the  use  of  the  methodolofy  includint  a  crashworthiness 
design  problem,  when  a  plastic  lunge  concept  has  been  used  to  model  plastic  deformauons  of  the  vehicle 
structure  during  the  impncL 


1.  Introduclion 


During  (he  last  twenty  years,  computer  aided  analysis  of  crashworthiness  and 
smiciural  impact  hw  received  a  large  attenuon  and  is  shout  to  emerge  as  a  powerful 
methodology  to  be  successfully  applied  in  practical  situations. 

Different  nuinencal  fotmulaiions  with  varying  degree  of  compleaity  and  accuracy 
have  been  proposed  by  Kamal  (1)  using  spring  mass  models  and  by  Pifico  and  Winter  [2] 
and  Hajxluk  et  al.  (3|,  using  finite  element  methods.  Recent  efforts  in  the  field  of  non¬ 
linear  structural  dynamics  have  contributed  for  the  development  of  well  known 
commercially  available  codes  such  as  PAM-CRASH  14)  and  RADIUS  which  are 
enhancements  of  the  public  domain  codes  DYN.V3D  IS)  and  WHAMS  {6).  These 
programs  can  simulate  with  improved  accuracy  several  different  structural  impaa 
phenomena,  such  as  large  localized  deformation,  structural  insubilities,  transient 
vibrations  and  stress  wave  propagation.  These  codes,  however,  requite  large  computer 
resources  which  make  them  rather  unsuitable  as  part  of  a  design  tool  to  be  used  in  the 
early  design  stages. 

As  a  renill,  design  for  crashworthiness  is,  in  most  indusmal  siiuaiions,  still  done 
empincaJly  or  is  b«d  on  experunents,  yet  some  ciashwonhiness  design  capabilities 
have  been  diveloped  and  reponed  in  the  literature  (7-9). 
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In  general,  design  sensitivUy  analysis,  DSA,  since  il  involves  the  calculation  of  cost 
and  peiformance  functionals  gradients  w.r.t.  the  design  variables  represents  a  necessary 
step  in  the  optimization  process  and  provides  an  important  tool  for  design  improvement 
and  "what  iT  studies. 

The  DSA  for  the  dynamic  response  problem  for  structural  and  mechanical  systems 
has  been  traditionally  treated  with  separate  fonnulations  by  Haug  and  Aioia  (10),  Hsieh 
and  Aiora  (It),  Menc  (12),  Haug  and  Mani  (13),  TortorelU  an  Lu  (14),  Choi  and  Wang 
(15),  More  recently  Cardoso  and  Arora  (16)  have  proposed  a  unified  approach  for 
structural  and  mechanical  systems  using  the  adjoint  structure  concept.  However  the 
adjoint  formulations,'  yield'into'a  terminal  value  problem  that  needs  to  be  integrated 
backwards  in  time  resulting  in  a  more  complicated'computadonal  implementation  as 
compared  to  the  direa  differentiadon  method  which  has  been  adopted  herein. 

In  this  paper  a  crashworthiness  design  methodology  is  presented  where  a  structure  is 
approximated  by  a  multibody  constrained  mechanical  system  with  revolute  joints  and 
non-linear  revolute  springs  representing  plastic  hinges.  This  type  of  models  have  been 
successfully  used  in  vehicle  crash  simulations  (17-19),  For  selected  structural 
comimnents,  design  variables  are  defined  representing  the  coiresponding  linear  elastic 
bending  sdfhtess  and  the  associated  limit  plastic  moments. 


2,  Dynamic  Analysis  of  Multibody  Systems 


For  planar  systems  a  3  dimensional  veoor  of  Cartesian  generalized  coordinates,  qi,  is 
defined  for  each  rigid  body:  one  rotational  and  two  translational  coordinates.  The 
conflgutadon  of  a  mechanical  system  can  be  described  by  the  nc  veaor  of  Canesian 
cooidinates,  q,  containing  the  genenlized  coordinates  of  all  bodies  in  the  system. 

These  coordinates  ate  not  all  independent  due  to  the  existence  of  constraints 
lepiesenung  different  kinematic  joints,  su^  as  sphencal,  revolute  or  translational  jomts. 
The  cotresponding  nh  constraint  equations  can  be  written  in  the  form 

<»  ■  OKq.t)  =  (1>i(q.t).<l':(q.tX...'>Ba(q.t)]'^  =0  (1) 


Differentiating  (1)  twice  w.r.t.  rime 

<fcaOqq-f<b,  aO  (2) 

and 

<i>»<t>,q-y  (3) 

where  Y  = -{‘t>,q)^q-2<l><,iq 

The  Lagrange  equations  of  motion  for  the  muiabody  system  can  be  wntten  as 


I 

I 

'i 
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M  q  +  OjX  =  g  (4) 

where  M  is  the  nc*nc  generalized  mass  matrix,  g  is  the  nc  generalized  force  vector  and 
X  is  the  nh  vector  of  L^range  multipliers.  Equations  (3)  and  (4)  can  be  organized  in  the 
matnx  fonn 


M  tjl/ql 

K,  ojur 


fonnmg  a  xt  of  differential  algebraic  equations  which  has  to  be  solved  for  the 
accelerations  q .  The  vector  of  Lagrange  tnubipliets  X.  is  a  by  produa  of  the  soiution  that 
can  be  used  with  great  advantage  to  obtain  the  reaction  forces  in  the  joints.  The  reader  is 
refetred  to  reference  (20|  for  more  details. 

Using  a  proper  integration  scheme  (21),  equatton  (S)  can  be  mtegrated  in  time  to 
obtain  the  velocittes  q  and  the  positions  q. 


3.  Design  Sensitivity  Analysis 


The  design  problem  can  be  stated  m  following  foim 

Minimise  b )  (6) 

Subject  to  the  constraints 

'^W="EIi  =  llucon 

b>  S  b  S  bU 

where 'l">(b)and'{''(b)are  functionals  representing  the  objective  function  and  the 
constiiints  respectively,  and  neon  is  the  number  of  constraints,  b*  and  b'^  represent 
technological  lower  and  upper  bounds  on  the  design  variables  and  may  also  reflect 
acceptable  structural  designs  for  the  eirstic  structure  under  normal  loading  conditions, 
ip  0  ( b )  and  'Plfb)  are  funaio.ts  of  the  nb  design  variables  b  =  (bi.  br, ...  bni,F.  b  is 
also  function  of  the  state  variables  which  include  positions,  velocities,  accelerations  and 
Lagrange  multipliers,  thus 

ip.jq/o,  vpciT  =  4/(q,q.  q.x,t,b)  (9) 


During  the  optimization  process  the  cost  and  constraint  functional  must  be  evaluated 
as  well  as  the  correspondmg  gradients  v .  '.l  the  design  variables 

>p:=^  and  S-:  =  ^  (10) 

A  sensitivity  mattix,  L,  can  be  defined  such  that 


db 


SbsL^Sb 


(11) 


Different  types  of  constraints  have  to  be  considered  which  may  correspond  to 
different  design  oitena  for  the  dynamic  response  problem  (lO); 
cl)  Functionals  of  the  paidculat  type  wiA  the  fotm 


“F  a  max  f<q,  q,  q,  X.t.b)  for  t®  S  t^  fi  t' 


(12) 


may  represent,  for  example,  the  maximum  acceietadon  which  occurs  during  the  impact 
in  a  particular  point  of  interest  in  the  sttucture  only  once  and  at  djstina  time  i).  t<l  and  t' 
are  the  initial  and  final  time  of  the  impact  period,  respectively. 
c2)  Funcrianals  of  the  integral  type  with  the  form 

It 

'F  =  )f(q,q.q,  X.t.b)  dt  (13) 

.0 


may  represent  either  the  total  energy  absorbed  or  a  standard  measure  of  vehicle  crash 
seventy  index  which  is  given  by  (7| 


VCSI  = 


(14) 


where  -aft)  is  the  deceleration  of  the  passenger  compartment  or  the  passenger  itself 
when  soUdng  an  obstacle,  as  for  example,  the  front  panel  in  a  bontal  collision  or  a  door 
in  a  side  impact  simadOR. 

Using  the  direct  diffeiendation  method,  as  proposed  at  reference  |13],  a  first  step  for 
the  design  sensidvity  analysis  requites  the  linearizadon  of  the  funcdonals  (12)  and  (13). 
Without  loss  of  generality  just  consider  the  first  case 


d'V 


(f,8q  +  f^8q  +  f^8q  +  fx8X  +  rb5b) 


(15) 
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This  equation  requites  the  ehmination  of  the  dependency  on  the  state  vatiables.  From 


a  Taylor  senes  expansion  01  the  positio  vector 

q(t,  htdb)  =  q(t,b)  +  oi,  5b  +  qubSb  5bT + ..  (16) 

the  first  variation  can  be  obtained  as 

SqsqbSb  (17) 

Similarly,  the  fiist  vanarions  for  the  other  state  vatiables  can  be  obtained  as 

5  q  s  qb^b  (18) 

Sq=  qbSb  (19) 

5X=;q,Sb  (20) 

For  design  sensitivity  analysis  the  kinematic  constraint  equations  (1)  are  also 
functions  of  the  design  variables,  thus 

<bB<»(q.i.b)  =  0  (21) 

Calculnlng  the  first  variation  and  taking  into  account  (17) 

*q<lb  “  (22) 

Differenoaiing  (22)  twice  w.r.t.  time  the  sensitivity  equations  for  the  velocities  and 
accelerations  are  obtained 

♦qqb  “  -(®qq)q  4b  "  ^b  (23) 

♦q4b  •  ”*q4b  ~  2<b,qb  -  ^  (24) 

The  generalized  mass  matnx  and  die  generalized  force  vector  are  also  funcdons  of  the 
design  variables,  thus 

M  =  M(q,b)  (25) 

and 

k'  =  g(q.q.l.b)  (26) 

Taking  the  first  variation  of  the  system  dynamic  equations  of  motion  (5) 
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(27) 


Miib  +  =  8<i<Ib  +  Sqflb  +  8b  -(Mq),qb 

-(Mq)b  -(oJj.),qi,  +  (®JX)b 
Equations  (24)  and  (27)  can  be  wnnen  in  mamx  form  i-. 


Sqqb  +  gqqb  +8b  -(Mq)qqb  -(Mq)b  -('I>5X),qi,  +(‘b5x)bl 

-0,qi,-2ii>,qb-®b  J 

(28) 


which  can  be  integrated  m  time  with  the  inioai  conditions 

fqb(<‘’)  =  qb 
lqb(t®)  =  q? 


(29) 


Since  equations  (S)  and  (28)  have  the  same  left  hand  side,  they  can  be  solved 
simultaneously  to  obtain  the  state  variables  q,  q,  q,  X  and  the  sensitivities  qb,  qb,  tibi 
Xb.  This  fact  allow  a  yreatet  efficiency  in  tetms  of  computational  effons.  The  right 
hand  side  of  the  equation  (28)  has  obtained  using  symbolic  compulation.  Some 
examples  of  the  equations  obtained  by  symbolic  computation,  using  the  symbolic 
manipulation  progtam  MATHEMATTCA  (22),  ate  shown  in  the  Appendix. 

3.1.  OTOMEATION  PROCEDURE 


Several  optimization  algorithms,  such  as  the  feasible  diiection  method,  the  gradient 
projection  method,  and  the  linearization  method  are  coded  in  a  muld-puipose  program 
ADS  (advanced  Design  Synthesis)  (23),  which  was  used  in  the  present  work.  A  modified 
projected  gradients  melh^  (24)  was  selected  in  the  present  numerical  examples. 


4.  Crashworthiness  Opiimizilion  of  an  End  Underframe  Structure 


To  simulate  the  frontal  structure  of  an  end  underframe  of  a  railcar,  a  mechanical 
model  wa.-  developed  as  shown  in  figure  1  where  VI  and  V2  represent  initial  velocities 
for  a  front''!  and  oblique  collision,  respectiveiy.  In  the  geometric  disco  nnnuities  of  the 
smicture,  t  ighi  plastic  hinges  have  bem  modeled  to  simulate  the  plastic  behavior  of  the 
structure.  Each  plastic  hmge  has  a  torsional  spruig  mounted  over  a  revoluie  joint 
connecting  two  consecutive  bodies. 


The  non  linear  response  of  the  torsional  springs  is  described  m  terms  of  a  quasi  stauc 
moment  angle  relationship  .based  on  the  curves  for  plastic  behavior  proposed  by 
Anderson  ei  al.[2S). 

The  design  criteria  for  crashworthiness  in  the  prre%nt  case  has  been  based  only  on  the 
structural  response  predicted  by  the 'crashworthiness'  analysis  for  each  design  problem. 
Consequently,  an  objecdye' faction  is  defined  as  the  maximum  acceleration  ex^nenced 
by  the  front^  pan  of  the  smicture.  Other  objective  functions  can  be  defined  associated 
with  the  railcar  c^'seyerity  itidex  VCSL 

The  bmdihg  stiffiiess  K  and  the  plasric  moment  Ml  for  the  plastic  hmges  have  been 
chosen  asdesip 'variables:  These  two  mechanical  chatacteti^  which  ate  obtained  for 
each  cross' section  and  m  illusrrated  hi  figure  2  will  give  the  necessary  information  for  a 
proper  choice  of  optimum  design  cross  sections. 
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Figure  2.  Torsional  spruig  characteristics  for  the  plastic  hinges 

Unilateral  constraints  are  also  defined  to  impose  limits  on  the  maximum  structural 
crash  deformation  in  order  to  preserve  a  minimum  survival  space  in  the  car 
compaitmenL 

Three  crash  situations  have  been  simulated  at  a  velocity  of  6.88  m/s.  The  first  one  (SI) 
is  a  frontal  impact,  the  second  (S2)  and  the  third  (S3)  are  oblique  collisions  where  the 
initial  velocity  V2  make  an  angle  of  30°  with  the  longmidinal  direction.  In  crash 
situations  SI  ^  S2  only  longituduial  displacements  consoiints  ate  imposed,  and  for  S3 
an  additional  lateral  constraint  also  has  been  imposed. 

The  objective  Ainction  and  constraints,  could  be  presented  as 

Rndb  suchthat  (lyg(t.b)l)isniiniiTiiz(4 
Subject  to:  max.  (IOisplacement(tJ>)l>X)<:0 

The  maximum  displacements  X  have  respectively  the  values,  Xsi=d).879, 
Xs2=0.479m,  Xs3=0.279m  and  Xs3=03605m  to  the  lateral  constraint.  For  the  impact 
siniations  S2  and  S3  a  simulation  time  t=0.1s  has  used. 

Two  design  variables  ate  considered  as  b  =  (bi,  ba)  =  l»i.  Mil,  where  6\  and  Mi 
characterize  the  slope  K  and  the  plastic  moment.  The  initial  design  vector  is  b= 
{0.0873. 46M)  and  me  lower  and  upper  bounds  are,  b|  s  (0.001,  80()|  and  bu  -  (0.1, 
8000). 


For  the  impart  situation  St,  the  results  of  the  displacement  and  acceletanon  for  the 
initial  and  optimal  scludon,  am  shown  in  figures  3  and  4.  respecDvely.  This  results 
show  that  the  decrease  in  the  maximum  acceleration  has  achieved  with  a  larger 
deformation. 


Time(s) 

Figure  3.  Displacement  for  the  impact  simanon  S 1 


Timefs) 

Figure  4 .  Acceleration  for  the  impact  sinianon  SI 


The  results  of  the  displacement  and  acceleration  for  the  impaa  situation  S2.  ate 
shown  in  figures  S  and  $  respectively. 

The  substantial  decrease  in  acceleration  levels  resulted  from  the  fact  that  the  specified 
displacement  consttaints  yield  an  optimum  solunon  conesponding  to  a  very  compliance 
sttucture. 


Tlme($) 


Figure  6.  Acceleration  for  the  impaa  situation  S2 

Hie  resuils  of  the  dispiacement  and  acctieration  tor  the  impaa  situation  S3,  are 
shown  in  figures  7  and  8  respeaively. 

In  this  case,  a  very  strong  longinidlnal  constraint  were  imposed,  resuiting  in  a 
constraint  violation  for  the  initial  design.  Ilie  optimal  solution  corresponds  to  a  more 
sdff  stiucture  resulting  in  higher  ievels  of  accelention. 


5(2 


Figure  7.  [Msplacement  for  the  impact  situation  S3 


Figure  8.  Acceleration  for  the  impact  situation  S3 


Table  1  summarizes  the  results  obtauied  m  cases  SI,  S2  and  S3.  The  results  clearly 
show  that  decrease  in  acceleration  levels  are  obtained  by  relaxing  the  amount  of 
stmctural  permanent  defoimadon  during  impact  On  the  other  side  mease  S3,  the  lower 
deformation  required  in  optimal  design  implies  a  higher  level  of  ccceletadon. 

In  optimal  design,  all  the  constraints  were  satisfied,  and  the  convergence  of  the 
optimizatioi'  process  has  verified,  for  all  the  impaa  siniauons. 

The  results  of  the  optimal  design  variables,  allow  to  choose  opnmal  cross  sections  to 
the  end  underfiame  structure. 


I 
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Tabte  1  -  CmhwonliiiMss  Problem  of  The  End  Underframe 


Crash  Situation  i 

SI 

S2 

S3  1 

lef.ffli'IHI 

UStSM 

cusm 

Objeenve 
Function  (G) 

7.49 

656 

7.41 

3.84 

7.41 

11.74  1 

Ccns.Dir.OY 
"  O.X 

.9.4x10-7 

-3.4x10-5 

l.lxlO-‘ 

6.8x10-4 

BISEB 

HEIdt 

0.0873 

■OH 

EiTiSVkB 

mfraia 

mmKm 

4644.7 

mmwM 

ICPUTimels) 
1  (VAX  9000) 

5206 

4017 

3626  1 

5.  Concliuioiu 


An  efficient  design  methodology  was  developed  for  the  purpose  of  studying  an 
optimal  vehicle  body  stnicture  in  a  criuh  siiuaiion. 

This  methodology  has  been  developed  within  the  ffamework  of  mathematical 
programming  methods  involving  an  efficient  dynamic  analysis  capability  where  a 
vehicle  structure  is  modeled  by  rigid  bodies  connected  by  plastic  hinges  to  modulate 
large  structural  deformations. 

The  capability  of  this  methodology  has  been  demonstrated  for  a  end  underframe 
stnicture  In  two  impaa  situations,  a  tental  impact  and  a  oblique  impact. 
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Appendix 


i 


In  this  appendix  the  general  form  of  some  terms  of  the  equations  of  sensitivities  (28) 
is  shown.  These  terms  have  been  obtained  using  the  symbolic  manipulation  program 
MATHEMATICA. 

The  first  column  is  for  a  linear  spring,  as  an  example  of  an  actuator,  and  the  second  for 
a  translation  joint  as  an  example  of  a  kinematic  joint. 


Sb 

OB(t,l)«ELX*DELEUEL 
OB(U}«ELY«DELEL/EL 
GB(1.3)«XPIMXI<aY*OELEUEL 
«YPlMYI*ELX*DFI.F,IjEL 
QB(t,6)»-(aY*XP;MXl«  DELEUEL) 
+YPMYJ*EU*DELEL/EL 
OBai)-ELX*£LO 
OB(U}«aY*ELO 
GB(2J)-XPlMXl«aY«EU)/a  • 
YPIMYI*ELX«ELD/a 
GB(2.tf)«KaY«XPJMXJ*ELO/a) 
♦YPJMYJ«ELX*ELD/a 

G<X!,l)«EUC*(-(ELX*SP(lC4)/a)  - 
ELXD«SP(K.eva4-ELX«< 

(ax'ELXD  ♦aY'aYD)*sp(K,dy 
(a*n)**3/2va 
♦ELX**2«FFAa**2)**3/2  •  FF/a 
OQ(U)«ELX*(-(aY*SP(KJ)/a)  • 
aYD*SP(K,«)/EL+aY** 
(ELX«EUCD  <faY*aYD)*SP(K.6)/- 
(a**2)**3/2y 

a+aY*ELX*FF/(a**2)**3/2 
GQ(5  J)«FLX*((2*-XPIMXI*ELX)*SP(K.5V 
iZ^eih  (KQD(3X)**YPlMYI*aYH 
QD(3X)*XPIMXI*-  aX+YPWYl* 
ELXD-XPIMXI«aYD)«SP(K.«V<  a- 
<2*-XPIMXl*ELX)*(ELX«EUCD 
♦ELY*aYD)**  SP(K.6V(2*(a**2) 
••3/2)V  a  -  ELX««  (J*-XPIMXI*aY 
2«YPIMYI*ELX)«FF/‘  a*(a*»2)**3/2) 
+  YPIMY:*FF/a 


«q 

OQD(l.l)»-(aX**2*SI>(K.6)/a**2) 

OQD(uwaY*ax*sp(iwva**2) 

OQD(13)*ELX*(-(XPIMXI*aY) 

+YPIMYI*ELX)*SP(K.6Va**2 


FQQDQ11,1|-QD(3X)»U1 
FQQDQ(U1-QD(3X)*VI 
FQQ0Q(UM0D(14)*UD  +  QD(IX)*UI ' 
QD(2J)*V1  *  QD(2X)»VI  •  QD(3  J)* 
(•VIWJMXJ  +  UI'YPJMYJ).  QD(3X)* 
(•YPIMYl»UI  ♦  2»XPIMXI*V1  • 
XPIMXI*VI-fVl*  .  (Q(lJ)»Q(iX) 
‘XP1MX14*  XPWXn  -UI*  •  ((X2J) . 
Q(U)*YPIMYI^YPJMYJ)) 


(♦q  q)q 

FQQODQI M  )-QDDOX>*UI 
FQQDDQ(UKODOX)*VI 
FQQ0DQ(IJMQDD(1J)«UD4>QDD(1X)*UI- 
QDO(2J)*  VI+  QDD(U)«V1.  QDD(3  J)* 
(•VI*XPJMX;  ♦  UI*YPJMYJ)-QDD(3X) 
•(•(YPIVtYI^UIH  2»XPIMXI*VI. 
XPIMXi*  VI.  Vl*(Q(l  J).(3(»X)* 
XPIMXI*  XPJMXI)  ♦Ul*(Q(2J).  Q(U). 
YPIMY14-YPJMYJ)) 


l(«»qq)qqlq 

FQQDQQDQ(MMDaX)**2*VI 
FQQDQQDQ1UWD(3X)**2*UI 
FQQDQQDQI  Uh  W2J)*QD(3X)*UI* 
QD(U)*QD(3X)*UI. 
QD(IJ)*QD(3X)*VI. 
QD(IX)*QDOX)*VI.  QD(3J)*(QC>OX)* 
(•UI*XPJMW.  Vl»YPmY3). 
QO(3.J)*(UI*XPJMXJ4.  VI*YPWYJ)H 
QD(3X)*(QD(2J)*in+ 
QO(U)*UW}0(lJ)*VI.QD(a)*-Vl. 
QDaj)*(.ui*xpjMx; .  vl'YPmYj). 
QD(3X)*('2*XPIMXI*UI4.3*XPIMXI*UI 
♦YPIMYI*  VI.  UI*  (Q(l  J>  Q(IX)« 
XPIMXI^  XPJMXJ>.VI«(Q(XJ>.  Q(2X>. 
YPIMYI^yPJMYJ))) 


■wTssuwssar 


THE  MULTIDISCIPLINE  DESIGN  CONCEPT  FOR  MECHANISMS 


O.L  Sivemen 

The  Umversity  of  Trondheun 
The  Nowegian  Inetinite  of  Technology 
N  -  7034  Trondheim 
Norway 

T.  Rolvig 

SINTEF  Production  Engineering 
N  ■  7034  Trondhjun 
Norway 

HP.Hildrc 

The  University  of  Trondheim 

The  Norwegian  Institute  of  Technology 

N  •  7034  Trondheim 

Norway 


ABSTRACT.  This  paper  describes  a  design  concept  for  multi  body  systems  developed 
in  the  ESPRIT  II  #3324  project  called  "High  peiformance  computing  for  multidiscipline 
dynamic  simuladoo  of  mechanisms"  (MDS)'.  The  concept  is  based  on  a  sunulanon  tool 
combining  muld  body  simulatioa,  the  finite  element  method  and  control  engineeiing 
(FEOEM)^  The  tool  is  developed  finther  widiin  the  MDS  project  to  complete  an 
automatic  design  optimizadon  loop  including  dynamic  simulation  and  sensitivity  analysis. 
The  project  is  aiming  for  an  interactive  desip  environment  based  on  simultaneous 


Running  from  Nov.  1990  to  April  1993  with  pannen  from  Germany, 
Italy,  England.  Sweden,  Norway  and  cooniin^  by  the  Danish 
Technological  Institute  in  Oenmaric. 

FEOEM  -  Finite  Element  Dynamics  of  Elasic  Mechanisms,  A  multi¬ 
discipline  simulation  tool  for  mechanisms  developed  by  The  Norwegian 
Institute  of  Technology  and  SINTEF  Produenon  Engmeenng,  Norway. 
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simulation  and  result  presentation  as  curve  plotting  and  animanon.  The  designer  may  also 
inspect  the  results  as  animanons  of  mechanism  monon  includmg  scaled  defotmanons  of 
bo^es  and  stress  contour  fringes.  A  Modf-based  program  manager  tool  is  developed  to 
control  program  execun'on  and  data  flow  between  the  different  nodules  invoiced  that 
simplifies  the  designen  inBraction  with  the  symm.  Also  a  STEP  toolkit  is  developed  to 
standardize'daita  co^uniratibn  between  internal  and  external  program  modules.  There 
has  been  developed  an  interface  for  simultaneous  dynamic  simulanon  between  the  internal 
mulddiscipline  simuladon  tool  and  an  external  sunuladon  tool  like  for  instance 
MATLAB’,  with  the  simuladon  model  distributed  between  the  programs. 


1.  INTRODUCTION 

The  MDS  consortium  were  based  on  the  software  packages; 

■  FEDEM  -  for  mulddisciphne  dynamic  simuladon  of  mechanisms  based  on  a 
nonlinear  finite  element  formulation. 

a  FEMOEN  /  FEMVIEW  -  for  finite  element  pre-and  post-processmg 

•  KISMET  •  for  high  performance  animation 

a  OPOS  •  for  Optimization  analyses 

a  SESAM  •  the  FEM  analysis  system 

Based  on  the  software  packages  mentioned  above  the  objectives  for  the 
project  were: 

a  Combining  and  extending  the  actual  software  packages  for  multidiscipline 
Simaladon.  FEM  pte-and  post-processing,  mechanism  animanon  and  optimizanon 
analyses. 

a  Extending  the  functionality  of  the  simuladon  software  according  to  the  applicanon 

parmer's  needs. 

a  Extending  the  modelling  and  visualization  capabilities  within  the  field  of 
mechanisms,  including  an  overall  Motif-based  user  inter&ce. 

a  Developing  STEP  interfaces  for  data  communication 


MATLAB  -  A  commercial  available  simulanon  system. 
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Developing  an  opdnuzaiion  tool  for  mechanisms. 


Applying  the  software  within  the  fields  of  robotics,  aerospace.  SME-  appiicanons 
etc. 


2.  THE  MULTIDBCIPLINE  SIMULATION  SOFTWARE 

The  simulation  system  FEDEM  is  a  general  purpose  simulation  system  for  mulddiscipline 
d^amic  sinuilatiaa  -  of ,  mechanism  motion  combining  a  non-linear  finite  element 
formulation  with  mechanism  and  control  analysis.  The  different  links  of  a  mechanism  are 
modelled  flexible  from  a  libiaiy  of  beam,  shell  and  solid  finite  elements.  The  links  ate 
join^  together  by  a  set  of  joint  types.  Liner  and  non-linear  springs  and  dampers  may  be 
included  in  a  mo^  between  links  and  in  joints.  Time  dependent  monon  and  loading  may 
be  included  on  links  and  in  joints.  From  a  libriiy  of  control  elements,  a  control  system 
for  the  mechanism  may  be  modelled,  taldng  the  measurements  from  the  mechanism 
variables  and  genetatmg  actuator  forces  on  the  mechanism. 

Based  on  the  user  specified  tequirements,  extended  modelling  functionality  were 
developed  (3,4,6,7,12,13,21].  The  new  modelling  functionality  developed  within  the 
project  are,  new  and  Luprov^  joint  and  nansmiasion  models,  joint  and  gear  friction,  user 
subroutitie  interface,  extended  control  element  library  etc.  A  typical  FEOEM  feature  is 
the  flexiUe  sliding  joints  based  on  the  prismatic  and  cyliodric  joint  primitives.  These  may 
be  used  to  model  for  example  flexible  telescopic  joints. 

A  simullaneous  interface  to  an  external  controller  stmuiadon  package  are  also  developed 
and  implemented  with  MATLAB  as  the  external  simulation  package.  The  interface  is 
based  on  a  general  purpose  socket  communication  for  a  computer  netwotk.  and  the 
simuladon  codes  (in  this  case  FEDEM  and  MATLAB)  may  run  on  the  same  or  on 
different  computers  in  the  network.  For  the  external  MATLAB  package  a  user  written 
subroutine  is  added.  In  this  way  the  control  engineer  may  model  the  control  system  m  a 
simulation  package  that  he  is  fruniliar  with  as  an  alternative  to  modelling  also  the  control 
model  dire^y  in  FEDEM.  However,  longer  computer  times  will  be  the  penalty. 

A  functionality  for  generating  modal  animation  of  mechanism  deflection  is  developed, 
and  also  rigid  body  kinematic  simuiaoon  is  made  available  in  FEDEM. 


3.  MODELLING  AND  RESULT  VISUALIZATION 

For  the  mulaQ.scipline  dynamic  simulation,  the  links  ate  modelled  as  FEM  substructures. 
Within  the  project  the  general  purpose  FEM  preprocessor  FEMGEN  art  used  for 
generating  the  FEM  models  for  the  dtfferent  links  of  a  multi  body  system.  Conversion 
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of  the  FEM  models  to  the  input  fonmt  of  the  simulation  program  is  straight  forwanl  as 
for  any  general  purpose  FEM  program. 

Modelling  the  system  model  for  a  mechanism  is  usually  not  a  funcnonality  of  a  FEM 
preprocessor,  and  a  new  module  is  developed  within  the  project  for  this  purpose.  This 
mechanism  modeler  may  impon  the  FEM  models  for  the  different  bodies  of  the 
mechanism  ^m  the  F^  preprocessor.,  in  this,  case  FEMGEN.  It  is  also  of  interest  to 
ei^brt  coo^ttes  of  points  on  each  link  relative  the  link  coordinate  system,  for  instance 
for  jomis.  springs,  da^pm.  loads  etc.,  to  the  FEM  ptrprocessor  as  external  points  for  the 
FEM’,mek.‘,Tlie  nmhaniiun'  modeler  will  display  shnpliiied  drawings  for  the  diSerent 
bodies  and  pceseht  Joln^  springs,  dampers,  loads  etc.,  as  graphic  symbols  on  the  display. 
Cobool  m^ls  integnted  in  a  mechanism  ate  generated  through  numerical  input, 
however,  these  data  will  also  be  entered  graplucaily  in  the  next  version  of  the  mechanism 
modeler. 

A  large  amount  of  different  kind  of  results  are  generated  during  a  dynamic  simuladon 
run.  The  result  are  generated  on  two  levels,  the  mechanism  and  the  link  level,  as  for  the 
modelling.  Typical  result  on  the  mechanism  level  are  posidons.  velocides.  acceletadons. 
forces,  tcmiues  in  external  nodes,  joints,  springs  and  dampers.  These  type  of  data  ate 
most  conveniendy  presented  as  variable-time,  or  variable-variable  curve  plots.  Also 
variadon  of  eigenvalues  at  system  level  and  control  variables  are  most  conveniendy 
preseiited  at  curve  plots.  However,  animadon  of  modon  of  the  simulated  muld  body 
systm  is  a  very  inpottant  tool  for  the  designer  (analyst)  as  a  first  check  of  the  simulated 
results,  especially  when  the  simuladon  and  visualiaadoo  models  are  the  same.  Canying 
out  some  extra  lEM  processing  of  the  results,  the  animadon  of  modon  may  also  include 
scaled  defoimadons  of  bodies  and/or  Von  Mises  stresses  on  the  body  surfaces.  This  gives 
the  desig^  very  good  insight  into  the  dynamics  of  his  system. 

If  the  simuladon  also  has  specified  eigenvalue  analysis  for  certain  ume  incidents,  the 
dgenvectois  may  be  used  to  visualize  eigenmodes  of  the  system.  The  first,  second,  third 
etc.  eigenmodes  for  a  certain  posidon  may  be  visualized  as  mode  animadon  by  scaling 
the  eigenvector  by  a  sinus  funcdon. 

The  FEM  results  for  the  different  pasts  of  a  mechanism  may  be  displayed  individually 
in  a  FEM  postprocessing  program  after  converting  the  results  to  the  actual  visualizanon 
programs  database,  as  within  this  project  is  FEMVibW.  All  facilides  for  FEM 
visualizadon  within  the  FEM  pos^rocessor  is  dien  available  for  result  visualizadon.  Also 
FEM  results  on  the  assembled  mechanism  may  be  visualized  in  the  FEM  postprocessor. 

Because  of  the  large  models  and  amount  of  results  in  a  FEM  analysis,  tradinonally  the 
analysis  is  divided  in  preprocessing,  FEM  analysis  and  postprocessing.  However,  for 
mulddiscipUne  simuladon  in  the  MDS  project,  we  are  invesngatmg  the  possibilides  for 
simultaneous  analysis  and  result  visualizadon  on  a  high  perfoimance  computer  system 
using  process  to  process  communicadon  between  the  simuladon  program  and  a  set  of 
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visualizanon  programs  for  ammaiian  of  modon,  curve  plotting  etc  (1.5,10,18.2324).  The 
user  is  m  this  .way  mteracdvely  controlling  simulation  parameters  during  simulation,  and 
if  the  simulauon  model  is  showing  unexpected  behavior,  the  simuladon  may  be  stopped 
and  checked  more  in  detail  before  continued,  possibly  with  modified  integrauon 
parameters.  Altemanvely,  the  simuladcm  is  terminated  and  the  simulanon  model  is 
modified  before  a  new  simuladon  is  initiated.  In  this  way  the  user  is  in  full  control  of 
his  simulanon.  with  better  understanding  of  a  simuladon  model  and  fewer  failure 
simuladons.  The  less  produedve  waiting  times  dining  off  line  simuladons  will  m  this 
way  be  eliminated,  and  the  user  may  concentrate  on  the  most  resent  results  as  they  are 
generated. 

Within  the  MDS  project  this  philosophy  is  only  tested  for  relanvely  small  simulanon 
models  because  this  approach  is  very  much  depradent  on  the  computer  power  available 
for  simuladon  and  visualizadon.  To  make  this  a  working  soludon  for  larger  models, 
much  more  computing  power  must  be  available  for  instance  through  parallelizadon  of  the 
simuladon  and  visualizadon  codes  between  a  number  of  high  performance  CPU's.  The 
super  element  approarh  for  the  simuladon  model  makes  it  very  well  smted  for 
parallelizadon,  especially  if  aJso  stress  analysis  are  to  be  executed  and  visualized 
simultwrousiy.  Certainly,  this  wotldng  philosophy  is  feasible  within  the  evolving 
computer  technology  for  relanvely  Urge  simuladon  models,  and  will  be  a  research  area 
of  high  priority. 


For  mulddiscipUne  simuladon,  a  wide  variety  of  computer  programs  are  involved  for 
model  genendon,  simuUdon  and  result  visuidizadon.  and  to  make  a  unified  workmg 
environment  for  the  user,  the  MDS-Program  Manager  (MDS-PM)  is  connoUing  the 
different  programs  that  are  made  avril^  to  the  user  and  are  keeping  nack  of  the 
conesponding  dara  and  the  transfomtadon  of  data  between  the  programs  [8,16,17], 
Program  modules  supplied  by  the  consoidrm.  here  called  internal  programs,  are  fully 
controlled  by  the  MDS-PM.  External  programs,  that  are  programs  not  controlled  by  the 
MDS-consordum,  are  connoUed  by  generating  a  window  on  the  workstadon  for  starting 
the  program.  These  progiams  are  then  living  quite  independendy  of  the  MDS-PM  unnl 
their  terminadon  ace  repotted  back,  and  the  workstadon  window  is  deleted.  The  MDS- 
PM  will  set  up  dependencies  and  sequences  between  the  programs  and  the  correspondmg 
data  models  used,  and  when  some  thus  are  changed  within  some  computadon  sequence, 
color  codes  are  used  to  inform  the  user  of  which  programs  has  to  be  re-executed  to 
complete  the  simulanon  with  this  updared  data. 


4.  DATA  COMMUNICA'nON  THROUGH  STEP  ETC. 

A  large  number  of  data  interfaces  for  the  mulddiscipline  simulanon  are  idennfied  within 
the  MDS-project  [2]  as  FEM  models,  mechanism  models,  control  models,  intermediate 
SimuUdon  models,  mtermediate  sunuUnon  results,  FEM  results,  surface  models  and 
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nansformadon  tmuices  for  aiiimaaon  of  modon,  Dme  senes  results  for  mechanism  and 
control  variables  ac.  All  uiese  data  should  be  handled  in  a  unified  way  and  controlled 
by  the  MDS-PM.  ppr  the  puiimiK  of  handling  and  controliing  ali  these  data  the  MDS- 
STEP  toolkit’ [IS]  wete  developed.  The  toolkit  is  intended  to  aid  an  applicadons 
pmgrarnma  in  the  acciusing  of  STEP  data.  Some  of  the  tools  provided  are  useful  in  the 
development  of  EXPRESS  daa  models  and  validadon  and  ptmting  of  STEP  exchange 
files.  The  toolkit  comprises  stand  atone  modules  and  a  hbtaty  of  funedons  to  access 
STEP  data. 

For  most  ot  the  data  interfaces  identified  above  in  the  MDS-project,  EXPRESS  data 
models  are  developed  and  implemented  through  the  STEP  toolkit  For  many  of  the  oata 
models  identified  no  standardized  applicadon  protocols  are  available  as  for  mechanism 
and  control  data,  and  working  STEP  models  for  the  MDS>pioject  are  then  developed. 
However,  where  standards  are  evolving,  as  for  FEM  data,  the  STEP  models  used  within 
the  project  comply  with  these  models.  See  Figure  1. 


Figure  1  MDS  STEP  model  overview 

A  new  multidiscipline  input  format  for  modeiltog  at  system  level,  are  developed.  The 
aims  of  this  new  foimat  are  to  be  more  objea  oriented,  and  to  have  as  few  redundancies 
as  possible.  This  fomiat  makes  mechanism  modelling  a  quite  straight  forward  task  for 
the  user.  Table  1  shows  the  ennty  names  used  in  this  foimat  and  Table  2  shows  an 
example  four-bar  mechanism  model 
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Table  1  Mechanism  entities 


1  KWE 

#  EarriTiEs 

DESCRIPTION 

MECHANISM 

1 

Mod«l  nan*,  gravity  constants, ate. 

ANALYSIS 

1 

Prograa  control  paraaatsrs,  ate. 

LINK 

1  :  « 

Link  position/oriantation  ate. 

TRIAD 

1  :  « 

Positions  for  coordinata  systams 
usad  in  joints,  springs,  danpars, 
loads  ate. 

JOINT 

0  :  « 

Joint  dafinitions 

SPRING 

0  :  # 

Axial  and  joint  springs . 

DAMPER 

0  I  » 

Axial  and  joint  dajopars 

MOTION 

0  t  « 

Motion  input 

K1CHER_PAIR 

0  ;  « 

Kodslling  of  transmissions 

FUNCTION 

0  t  « 

Functions  dafining  input  motions, 
foreas,  spring  stiffnass's  ate. 

CONrROL_MOD 

0  1  « 

Input  data  for  control  modula. 

CCNTROt^IO 

0  t  • 

Daflnition  of  control 

Inputs/outputs 

SENSITIVITY 

0  *  1 

Daflnition  of  sansittvley  output 
for  optimisation 

DTODATA 

X 

Indicatas  and  of  modal. 

Table  2  Four-bar  mechanism  model  example 


.'MECHANISM 

IS  •  1 

KECH_oescR  s  *exas9l«  I  in  PESEm  Sxu^l*  Manual* 

X.GMV  a  0.00006*00 

V.ORAV  a  -.98106*01 

2.CRAV  a  0.00006*00 


ANALYSIS 

IS  at 

AKA.06SCR  a  *6ath  followtno  Menanita* 

START.TXXC  a  0.00006*00 

eO..TQf6  «  0.10006*01 

YXMLmr  •  0.10006-01 

TSa.QO  a  0.10006-01 


1.0(6  10  at 

l.D(K_Dt8C6  a  *XnBUC  Link* 

LC6.06X0XM  a  0.00006*00  0.00006*00  0.00006*00 

LCajCEOQR*  e  0.00006*00  0.10006*01  0.00006*00 

laajitonrt  •  -.10006*01  o.oooo6*oo  o.ooooe*oo 

rtSX^ATJtXr  a  1 

Y^tAO  :0  a  I 

mAfi..StSA  a  'Oround  Triad* 

0M(BU.Q(R  a  I 

ORT.OAIOXM  a  0.00006*00  0.00006*00  0.00006*00 

GkTJtPOOrr  a  0.1Q006*Ot  0.00006*00  0.00006*00 

CRT.YPOOr  «  0.00006*00  0.10086*01  0.00006*00 

TKXAO  :0  m2 

t6lA0j)6sat  a  'Hiicar  Triad  for  deiac  :sa2* 
CMNCRj:,Q(K  a  1 

OXT.OKIOQI  a  0.00006*00  0.1$00f*00  0.00006*00 

ORTJCNOrr  a  0.10006*01  0.l$00t*00  0.00006*00 

CKT.YPOOrr  a  0.00006*00  0.18006*01  0  00008*00 


tO(6  10  a  3 

LXN1L063CR  a  *c^lar  Link* 

LCI.OXXQIN  a  0.00006*00  0.11086*00  0  00006*00 

LC6Ji»0XNT  a  0.80006*00  0.88006*00  0.00088*00 

LCa.YfOOrr  a  0.08006*00  0.20806*0*  0.00806*00 

rtBL.SAT_6Er  a  2 

LaOLHUS  a  0.80006*00 


ttW  10  a  1 

T6XA0j}isat  a  *slava  Triad  for  jolnc  is*2’ 

OkarOLLOIK  a  3 

dXT.CktOXN  a  0.00006*00  0.11006*00  0.00006*00 

drrj(MXNT  a  0.10006*01  0.11006*00  0  00006*00 

dRT.YKXtrr  a  0.00006*00  0.10006*01  0.00006*00 

76XAD  10  a  8 

l^tADjOCOCX  a  *Maarar  Triad  for  Jolnc  xOal* 

OtMRJ^XNK  a  2 

GKT.CaidXN  a  0.30006*00  0.37106*00  0  00008*00 

CkTJlKDrr  a  0.10006*01  0.37106*00  0.00006*00 

sKT^rfoaer  a  o.3ooo6*oo  o.iooo6*oi  o.ooooe*oo 
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CESCRIMION  or  TOE  OOTPCT  EINK 


:.s«T  :o  «  3 

LX2fl(_CC$CR  t  ‘Output  Lille* 

LCS.OKZOIM  •  0.i000e*00  0  3?soe*00  0  0000£*00 

LCSJCNINT  a  0.30COE‘00  O.OO0OE*OO  0  0000s»00 

Lcs.yroiOT  ■  o.ioooE«ot  o.ooooe^oo  o.ooooE*od 

FLSXJSATJlCr  •  ) 


TRIAD  XO  «  S 

TRXAO_BUat  ■  *3Uv*  TrUd  for  Joint  ID*3‘ 
CMflR^IKK  >  i 

CftT.ORXdIM  a  0.3000C*00  0  )7S0t«0O  O.O000E«00 

cRTjcrotxrr  ■  o.iooot*oi  o.iTsoti-oo  o.ooooc«oo 

cRT.rpoxxrr  •  o.iooot^oo  o.ioooc*oi  o.ooooe«oo 

) 

TOXAD  ID  ■  « 

TRXAD^CECR  •  ‘OrouRd  TrUd* 

OUNDULOnC  a  ) 

ORT.ORXQIH  a  O.)000E*O0  O.OOOOEaOO  O.OOOOBtOO 

CRTJirOtXrr  •  0.1090S«01  O.OOOOSaOO  O.OOOOE*00 

CRT.YPOim'  a  O.XOOOE^OO  O.lOOOEaOl  0.0009B*00 


I  OEiCRXPTXOH  or  TOE  f^LUTE  JOXm 


jonrr 

joorr 

joarr 

joarr 


X9 

JOXNTJEdOl 

JWT.TYfB 

dUV|.TOXAO 


Jdtm..otsai 

JW.TffE 

SUVS.TOXAO 

NAmR.TRXAD« 

t 

XO 

JoxmjstacK 

JW.TYFE 

AAVB.TOXAD 

MAfTni.TOXADt 


JoorrjsscR 

Jfrrjrrn 

SLAVB.TOXAO 


I 

'Mvoluco  joint  to  oround* 

RCV 

I 

i 

‘0«n«r«l  covoluto  joint* 
ACV 
} 

3 

3 

‘Conteti  rovoluto  joint* 

MV 

s 

4 


4 

‘Rtvolut*  joint  CO  around* 

rev 

4 


I  oucxxmoN  or  tkb  drxxHo  which  is  awirMTUC 

I  W*  nmn  MOTION.  TW  UNOTO  Of  W*  SFRINS  XJ 

I  (XNtTJJmi  *  dCALEJiRH  •  TaSi  HKZM  TIMS  XS 

i  THE  COMArr  SIMULATION  TOa. 

SPRXNO  n>  •  1 

SFRJSCSCK  ■  *Actu4cor  spri&o* 

smjnfrE  •  joiwr 

MrjOT  a  I 

joorrjor  a  zjwt 

QIITJUrrR  a  0.097»B*00 

SCAUJLMIH  •  •.43IOEaOi 

XNIT.STXr  a  O.lOOOEaOi 

SCAIA^XP  a  0.0000f«00 

f 

QjDOATA 
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An  EXPRESS  dau  model  for  this  fonnat  is  aboui  to  be  developed. 

5.  MECHANISM  OPTIMIZATION 

Optunizadon  analysis  are  about  to  be  a  standard  feature  for  the  designer  usmg 
conventional  FEM  programs.  In  mechanism  design,  especially  fleuble  mechanisms, 
however,  optimizatioa  analysis  is  a  new  feature  that  has  up  till  now  not  been  available. 
In  the  MDS  project  there  has  been  done  quite  inqioitant  developments  towards  an 
automatic  or  semiautomaric  optimizaiion  Icop  for  the  design  of  flexible  mechamsms 
(9.14,221. 

For  the  search  towards  an  optimum,  senadvity  gradients  from  the  simulanon  run  is 
essenuaL  A  sensidvity  is  defined  as  the  derivadve  of  a  response  variable  with  respect 
to  a  so  called  “design  parameter"  in  the  mechanism  model.  A  design  parameter  is  a 
parameter  in  the  model  effecting  one  or  more  input  data  for  the  simuladon.  Typical  input 
dau  that  could  be  effected  are  stiffness',  damping  coefficients,  addidonal  masses,  uudal 
condidons,  loading,  parameters  in  fiiocdoot  etc. 

Sensidvity  requests  defines  outpit  variables  from  a  simuladon  where  sensinvity 
calculadon  is  required  with  respect » the  desip  parameters.  Typical  sensidvity  requests 
may  be  for  posidons,  velocities,  acixicsadons,  spring  or  damper  foices  joint  variables  etc. 

The  seosidvides  are  calculated  from  pertubadng  the  desip  variables  one  at  a  time  m  the 
input  dau  and  the  seosidvides  for  aU  posidons,  velocides  and  acceleradons  of  pnmary 
simuladon  variables  are  evaluated.  These  seositivides  are  then  used  as  the  basis  for 
calculadog  the  requested  seosidvides.  The  sensidvity  analysis  during  dynamic  simulanon 
is  quite  efficient  because  the  tnangularized  system  matrices  from  the  integranon  could 
be  reused  for  the  sensidvity  analysis  requiring  only  forward  and  backward  subsotunon 
to  solve  for  the  sensidvides. 

Requested  tesponses  and  seosidvides  may  be  calculated  lepeatedly  in  the  opnmizaoon 
loop  and  the  desip  variables  are  updated  accordingly  in  the  simulating  model.  The 
optimization  algorithm  is  woridog  with  respect  to  a  set  of  constraints  for  the  simuladon 
responses  and  some  criteria  defines  when  the  opdmizanon  should  be  terminated.  The 
results  from  the  MDS  project  in  this  field  is  just  the  beginoing  of  what  seems  to  be  a 
very  promising  and  exciting  tool  for  the  desipcr  in  the  .unite. 


6.  MULTIDISCIPLINE  APPLICATIONS 


Within  the  MOS  project  the  simulation  tools  has  bten  apphed  on  the  IRB6000  industnal 
robot  (19,26)  by  ABB  Robotics  Products  AB  in  Sweden,  see  Figure  2, 


Figure  2  The  visualization  model  from  the  IBB6000  industnal  robot  simulation 
including  stress  contours 


Deployment  of  satellite  booms,  including  latching  [25],  were  simulated  by  Dormer  GmbH 
m  Ceimany,  see  Figure  3. 


Figure  3  The  visualUatum  model  from  the  satellite  boom  deployment  simulation. 

Machining  centtr  opentions  (31]  air  simulated  by  Syntax  Factory  Automidon  in  Italy, 
see  Figure  4. 


Figure  4  The  visualiiarion  model  from  the  machining  center  simulation. 


7.  CONCLUSIONS 

TTie  very  ambitious  objectives  set  up  for  the  MDS  project  has  to  a  large  extent  been 
fulfiUei  New  developments  and  applicadons  has  to  some  extent  been  miming  in  parallel, 
and  some  of  the  new  features  developed  towards  the  end  of  the  project  has  not  been 
tested  fiilly  in  real  applicadons. 

The  simultaneous  simuiadon  and  visualizadon  and  the  opnmizadon  and  sensidvity 
analysis  were  planed  as  test  implementadons  to  investigate  the  potentials  in  these  areas, 
and  from  the  experience  gained  so  far  it  is  very  promising. 

For  all  the  other  objecnves  for  the  MDS  developments,  the  resulting  programs  are  m  a 
state  close  to  a  commercialization  standard. 
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